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(57) A desired trajectory of a vertical component of 
a translation floor reaction force of a legged mobile robot 
1 , a vertical component of a total center-of-gravity ac- 
celeration or a body acceleration's vertical component 
of the robot 1 is determined, and a desired vertical po- 
sition of a total center-of-gravity or body of the robot 1 
is determined in such a mannerthat the vertical compo- 
nent of the translation floor reaction force, the vertical 
component of the total center-oF-gravity acceleration or 
the body acceleration's vertical component agrees with 
the desired trajectory (that is, a dynamical equilibrium 
condition in the vertical direction is satisfied). Since the 
movement of the total center-of-gravity or the like in the 
vertical direction is determined after the desired trajec- 
tory of the vertical component of the translation floor re- 
action force or the like, a desired gait forthe robot 1 suit- 
able not only for walking but also for running can be gen- 
erated. 
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Description 

Technical Field 

5 [0001] The present invention relates to a gait generation device for a legged nnobile robot which is suitable not only 
for generating a walking gait but also for generating a running gait, and to a control device. 

Background Art 

10 [0002] Conventionally, generation of a gait (desired gait) for causing a legged mobile robot, for example, a two-legged 

mobile robot to move has primarily been aimed to generate a gait (walking gait) which causes the robot to perform a 
smooth walking action. However, in recent years, as the development of the legged mobile robot has been advanced, 
it is desired to generate a gait that can cause the robot not only to walk but also run. 

[0003] Note that, since the word "gait" in Chinese characters includes a Chinese character meaning "walk", the word 
'5 tends to be misunderstood as meaning only walking. However originally, the word "gait" has a concept that also includes 

"running" as evidenced by the fact that it is used as a word for "trotting" or a running mode of a horse. 
[0004] Now. differences in characteristics between walking and running will be described. 

[0005] Typically running is defined as a movement mode which includes an instant at which all the legs float in the 
air However this definition cannot always definitely distinguish between walking and running. For example, during fast 
20 jogging, most people have ail their legs floating in the air at a certain instant. On the other hand, during slow jogging, 
many people have either of their legs always in contact with the ground. Defining the fast jogging as njnning and the 
slow jogging as walking seems to be slightly unreasonable. 

[0006] Figure 48 shows patterns of a body vertical position and a floor reaction force vertical component (i.e., the 
sum of the floor reaction force vertical components applied to the right and left legs) during typical running. Figure 49 

25 shows patterns of the body vertical position and the floor reaction force vertical component during typical walking. 

[0007] Here, the term "body vertical position/velocity" means the vertical position and velocity of a representative 
point of the body. The term "body horizontal position/velocity" means the horizontal position and velocity of the repre- 
sentative point of the body. The body vertical position A/elocity and the body horizontal position/velocity are collectively 
referred to as a body position/velocity. 

50 [0008] In addition, a "floor reaction force's vertical component* should be more precisely described as a "vertical 
component of the translation floor reaction force" in order to distinguish it from a moment component around a vertical 
axis of a floor reaction force. However since the word is lengthy, "translation" is omitted here. 

[0009] First, as for the movement of the body, when a robot walks, the body reaches the highest point at an instant 
when the body passes over the supporting leg. On the other hand, the body reaches the lowest point at that instant 

35 when the robot runs. That is, walking and running have inverse phases of the vertical movement pattern. 

[0010] On the other hand, the floor reaction force is relatively constant during walking, while, during running, it largely 
varies and reaches the highest value at the instant when the body passes over the supporting leg. Of course, the floor 
reaction force is 0 at the instant when all the legs float in the air From a more detailed observation, the floor reaction 
force produced during running is found to be approximately proportional to the extent of folding of the supporting leg. 

40 In other words, during running, the robot moves by jumping using the legs just like springs. 

[0011] Duringslow jogging, the body vertical movement has the same phase as that of the typical running. In addition, 
in many cases, slow jogging doesn't include an instant when all the legs float in the air Nevertheless, the floor reaction 
force is not completely but approximately 0 at an instant of switching of the supporting leg (free leg). 
[0012] Therefore, as described above, it seems reasonable and appropriate that walking and running are distin- 

45 guishedfrom one another based on the characteristics of the patterns of the body vertical movement and floor reaction 
force so that slow jogging is also included in running. 

[0013] In particular distinguishing between running and walking in a most characteristic manner it can be said that 
running is a movement mode in which the floor reaction force is 0 or substantially 0 at an instant of switching of the 
supporting leg, and walking is the other movement modes (in which the floor reaction force vertical component is 
50 relatively constant). 

[0014] In Japanese Patent Application No. 2000-352011 , the applicants have already proposed a technique for gen- 
erating a legged mobile robot's gait involving a floor reaction force in a flexible manner in real time while substantially 
satisfying a dynamical equilibrium condition (the dynamical equilibrium condition is abalance condition among the 
gravity, inertial force and floor reaction force for a desired gait, in a narrow sense, the condition is that the moment 
55 applied about the desired ZMP by the resultant force of gravity and the inertial force caused by the movement of the 
desired gait is 0. Details thereof will be described later). This technique and a series of control devices for legged 
mobile robots proposed by the applicants in Japanese Patent Laid-Open Nos. 10-86081 and 10-277969 and the like 
can be applied not only walking but also running. 
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[0015] However, according to these techniques, the body height (referred to as a body vertical position hereinafter) 
is determined in a geometrical manner based on the relative positional relationship between the body height and a 
foot, using the body height detennination method previously proposed in Japanese Patent Laid-open No. 10-86080 
by the applicants. Furthermore, the desired floor reaction force vertical component is not set in an explicit manner but 

5 determined as a result of (depending on) the body vertical position (body height) determined in a geometrical manner 
as described above. Therefore, a desired floor reaction force vertical component cannot always be produced. Thus, 
during running of Ihe robot in which an tnslanl when the floor reaction force vertical component is 0 or substantially 0 
has to be intentionally provided the floor reaction force vertical component produced as a result of a movement of the 
robot according to a desired gait may not be adequately reduced at the instant when the floor reaction force vertical 

10 component should be 0 or substantially 0. If such a case occurs, the instant when the both feet of the robot float in the 
air or when only one of the feet is slightly in contact with the floor cannot bo provided, so that it is difficult to mal<e the 
robot run smoothly. That is, the conventional techniques are not the optimum control techniques, because the floor 
reaction force vertical component pattern of the gait generated by the techniques is not always suitable for running. 
[001 6] In the first embodiment in Japanese Patent Application No. 2000-35201 1 . approximation of the body behavior 

^5 (modeling using a linear Inverted pendulum) is made on the assumption that the floor reaction force vertical component 
is substantially constant. Thus, as for running, which involves significant variation (or a wide range of variation) of the 
floor reaction force vertical component, the approximation precision of the body behavior is reduced, and there is a 
possibility that the stability margin for the robot Is reduced. 

[0017] Therefore, in order to generate a running gait orthe like which involves significant variation of the floor reaction 
20 force vertical component, the non-linear model described in relation to the second embodiment in Japanese Patent 
Application No. 2000-35201 1 (a model with higher precision) has to be used to generate a gait in a searching manner 
However, using such a non-linear model results in a higher nonlinearity and, thus, a degraded convergence in the 
searching process. Thus, an enormous amount of calculation is required, so that it is difficult to generate a gait in real 
time. 

25 [0018] Therefore, an object of the present invention is to provide a gait generation device that can generate a gait 
for a legged mobile robot which is suitable for not only walking of the robot but also running or other movement at a 

high velocity. 

[0019] Specifically, an object of the present invention is to provide a gait generation device that can generate a floor 
reaction force vertical component pattern and a movement pattern which are suitable for a gait mode, such as a running 
30 gait or walking gait 

[0020] Furthermore, another object of the present invention is to provide a control device for the legged mobile robot 
which can make the robot move smoothly with the gait generated by the gait generation device. 

Disclosure of the Invention 

35 

[0021] A gait generation device for a legged mobile robot according to the present invention is a gait generation 
device for generating a desired gait for a legged mobile robot that moves by operating a plurality of legs extending 
from a body, comprising: desired vertical component trajectory determining means for determining a desired trajectory 
of a vertical component of a translation floor reaction force applied to the robot, a vertical component of a total center- 

40 of-gravity acceleration of the robot or a vertical component of a body acceleration of the robot; and desired vertical 
position determining means for determining a desired vertical position of the total center-of-gravity of the robot orthe 
body thereof in such a manner that the vertical component of the translation floor reaction force, theverticalcomponent 
of the total center-of-gravity acceleration or the body acceleration's vertical component agrees with the desired trajec- 
tory determined by the desired vertical component trajectory determining means (first implementation). 

^5 [0022] In the following description of the present invention (including the implementations other than the first imple- 
mentation), for the sake of convenience, the vertical component of the translation floor reaction force, the vertical 
component of the total center-of-gravity acceleration of the robot orthe vertical component of the body acceleration of 
the robot will be sometimes referred to as a translation floor reaction force {orthe like) vertical component. In addition, 
the total center of gravity of the robot or the body thereof will be sometimes referred to as a total center of gravity (or 

50 the like). 

[0023] According to the first implementation, the desired trajectory of the translation floor reaction force (or the like) 
vertical component is first determined, and then, the desired vertical position of the total center of gravity (or the like) 
of the robot is determined in such a manner that the translation floor reaction force (or the like) vertical component 
agrees with the determined desired trajectory. 
55 [0024] Here; the vertical component of the translation floor reaction force is proportional to the sum of the vertical 
component of the total center-of-gravity acceleration of the robot and the gravitational acceleration. Furthermore, for 
example, in the case where the mass of the legs of the robot is sufficiently smaller than the mass of the body, the 
vertical component of the translation floor reaction force is approximately proportional to the sum of the body acceler- 
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ation's vertical component and the gravitational acceleration. Thus, a desired translation floor reaction force's vertical 
component can be produced not only by determining the desired trajectory of the vertical component of the translation 
floor reaction force itself but also by determining the desired trajectory of the vertical component of the total center-of- 
gravity acceleration or body acceleration's vertical component. Thus, according to the present invention, any of the 
5 desired trajectories of the vertical component of the translation floor reaction force, the vertical component of the total 
center-of- gravity acceleration or the body acceleration's vertical component may be set. Furlhermore, the sum of the 
gravitational acceleration and the second-order differential of the trajectory of the total center-of-gravily vertical position 
or body vertical position is approximately proportional to the translation floor reaction force (or the like) vertical com- 
ponent. 

10 [0025] Thus, if the desired vertical position of the total center of gravity of the robot or the body thereof is determined 
in such a manner that the translation floor roaction force (or the like) vortical component agrees with the desired tra- 
jectory of the translation floor reaction force (or the like) vertical component, the trajectory of the total center- of- gravity 
(or the like) vertical position is determined so that the translation floor reaction force (or the like) vertical component 
caused by a vertical movement (movement in the vertical direction) of the total center of gravity (or the like) of the robot 

15 agrees with the desired trajectory thereof. Thus, according to the present invention (the first implementation thereof), 
a desired gait (specifically a movement with a desired gait) can be generated which can produce a desired translation 
floor reaction force's vertical component or a translation floor reaction force vertical component approximately equal 
to the desired one. Since the desired gait generated can produce the desired translation floor reaction force's vertical 
component, the desired gait is suitable not only walking but also running (movement at a high velocity). Accordingly, 

20 the movement velocity can be increased while reducing the load on the legs and keeping high movement efficiency. 
[0026] For example, in the case of a two-legged mobile robot, if the translation floor reaction force (or the like) vertical 
component Is set to 0, both the legs (two legs) can be made to simultaneously float in the air, so that a bigger stride 
can be achieved. In addition, if the vertical component of the translation floor reaction force (or the like) is set to 0 or 
substantially 0, the load on the legs at the time of switching of the supporting leg is reduced. Thus, the duration of both 

25 the legs being in contact with the floor can be reduced, so that the period of one step can be reduced. In addition, if 
the vertical component of the translation floor reaction force Is set to 0 or substantially 0, the load on the legs at the 
time of switching of the supporting leg is reduced. Thus, the heel of the leg located rearward In the direction of travel 
of the robot can be readily raised, and the stride can be increased accordingly 

[0027] According to the present invention (the first implementation thereof), it is preferred that the desired trajectory 
30 of the translation floor reaction force (or the like) vertical component determined by the desired vertical component 
trajectory determining means is a substantially continuous trajectory (second implementation). According to this im- 
plementation, the vertical movement acceleration of the total center of gravity (or the like) of the robot can be continuous, 
so that the robot can be made to move smoothly Here, the words "substantially continuous" imply that a trajectory 
does not lose its continuity because of discrete values that inevitably occur when a continuous analog trajectory (con- 
as linuous trajectory in the true sense) is converted into a digital trajectory in a discrete-lime system. 

[0028] In the present invention (the first or second implementation thereof), it is preferable that the desired trajectory 
determined by the desired vertical trajectory determining means is a desired trajectory of the vertical component of the 
translation floor reaction force or the vertical component of the total center-of -gravity acceleration, and the gait gener- 
ation device comprises means for determining a desired position/posture of at least an end portion of each leg moving 
40 with the desired gait independently of the desired trajectory determined by the desired vertical component trajectory 
determining means (third implementation). That is, the desired trajectory of the vertical component of the translation 
floor reaction force or total center-of-gravity acceleration vertical component once determined defines the vertical move- 
ment of the total center of gravity of the robot. In this case, the movement of thetotai center of gravity generally depends 
on the movements of the body and . legs of the robot. In the third implementation, since the desired position/posture of 
45 the end portion (typically, a foot) of each leg is determined independently of the desired trajectory, that is, independently 
of the value of the vertical component of the translation floor reaction force or total center-of-gravity acceleration vertical 
component, the desired trajectory defines the vertical movement of the body of the robot. Thus, the vertical movement 
of the body, that is, the trajectory of the desired vertical position of the body can be detennined more readily 
[0029] In addition, in the first to third implementations deschbed above, it is preferable that, If the desired gait is a 
50 gait which alternately repeats a landing period, when at least one leg of the robot is in contact with the ground, and a 
floating period, when all the legs float in the air, as in the case of a running gait of a two-legged mobile robot, the desired 
vertical component trajectory determining means determines the desired trajectory in such a manner that the vertical 
component of the translation floor reaction force for the desired trajectory varies in a convex pattern within the positive 
value region during the landing period and is kept at 0 during the floating period (fourth implementation). According to 
55 this implementation, the desired trajectory of the translation floor reaction force (or the like) vertical component deter- 
mined is suitable for a running gait, and thus, a.movement (particularly, vertical movement) of the robot with a desired 
gait suitable for running can be detennined. That Is, it is possible to surely prevent generation of a desired gait that 
doesn't satisfy the requirements: the vertical component of the translation floor reaction force has to be 0 during the 
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floating period; and a sufficient translation floor reaction force vertical conaponent has to be produced during the landing 
period. Therefore, with the desired gait, the robot can be made to smoothly run, repeating the floating period and the 
landing period. 

[0030] In the fourth implementation described above, it is preferable that the desired vertical position determining 
5 means determines the desired vertical position of the total center- of -gravity (or the like) of the robot during at least one 
of periods close lo the start time and end Lime of the floating period based on a geometrical condition concerning 
displacement of a joint of each leg (fifth imptemenlalion). That is, in general, the leg to lal^e off the floor (leg located 
rearward in the direction of travel) is most likely to be fully stretched during the period close to the start time of the 
floating period (in the vicinity of the instant of taking off the floor), and the landing leg (leg located forward in the direction 
10 of travel) is most likely to be fully stretched during the period close to the end time thereof (in the vicinity of the instant 
of landing). At these timings, it is preferable that the legs are surely prevented from being fufly stretched in order to 
shift smoothly from the one-teg supporting period to the floating period or reduce the landing impact occurring at the 
time of shifting from the floating penod to the one-teg supporting period. Thus, in the fifth implementation, the desired 
vertical position of the total center of gravity (or the like) is determined based on the geometrical condition concerning 
15 displacement of a joint of each leg at the timings mentioned above, rather than being determined always based on 
only the translation floor reaction force (or the like) vertical component trajectory. Thus, the desired gait generated can 
prevent the legs from being fully stretched at the timings mentioned above and allow smooth shifting between the 
floating period and the landing period without any trouble. 

[0031] The geometrical condition concerning displacement of a joint of each leg is to assure that, in the case of a 

20 two-legged mobile robot, for example, the bending angle of the knee joint of each leg is kept equal to or larger than a 
predetermined angle (here, the bending angle of the knee angle fully stretched is assumed as 0 degrees). 
[0032] In the first to fifth implementations described above, after detemnining a provisional desired vertical position 
trajectory of the total center-of-gravity (or the like) of the robot based on a geometrical condition concerning displace- 
ment of a joint of each leg, the desired vertical component trajectory determining means comphses means for deter- 

25 mining a characteristic quantity of a variation pattern of the provisional desired vertical position trajectory, and means 
for determining the desired trajectory of the vertical component of the translation floor reaction force (or the like) in 
such a manner that the characteristic quantity of the variation pattern of the total center-of-gravity (or the like) vertical 
position trajectory of the robot corresponding to the desired trajectory substantially agrees with the detennined char- 
acteristic quantity (sixth implementation). 

30 [0033] According to this implementation, the total center-of-gravity (orthe like) vertical position trajectory determined 
based on the desired trajectory of the translation floor reaction force (or the like) vertical component has a pattern 
similar to that of the provisional desired vertical position trajectory based on the geometrical condition concerning joint 
displacement of each leg (that is, a pattern for which the characteristic quantities described above agree with each 
other). Thus, the total center-of-gravity (orthe like) vertical position trajectory that conforms with both the geometrical 

35 condition and the desired trajectory of the translation floor reaction force (or the like) vertical component can be deter- 
mined. Compared to the total center-of-gravity (or the like) vertical position trajectory determined only based on the 
geometrical condition in a conventional manner, the desired gait (in particular, the vertical movement) generated can 
produce the translation floor reaction force (orthe like) vertical component that is unlikely to be subject to temporary 
variation and varies smoothly. The sixth implementation is suitable for generating a walking gait of the robot, in particular. 

40 The characteristic quantities described above include the amplitude, phase, and frequency component (in particular, 
the amplitude and phase for a lower frequency component). 

[0034] In the first to sixth implementations described above, it is preferable that the device comprises a gait generating 
means for generating a normal gait which is a virtual cyclic gait following a current time gait which is a desired gait for 
a predetermined period by using normal gait parameters, in generating the current time gait to be newly generated, 

45 the desired gait being generated by separately generating gaits for predetemnined periods, the nomnal gait parameters 
being set in accordance with required parameters of the current time gait and including a parameter which defines a 
normal gait's desired trajectory of the translation floor reaction force (or the like) vertical component applied to the 
robot, and wherein the desired vertical component trajectory determining means detemnines the desired trajectory In 
such a manner that the total center-of-gravity (or the like) vertical position trajectory of the robot moving with the current 

50 time gait is continuous with or close to the total center-of-gravity (or the like) vertical position trajectory of the robot 
moving with the normal gait generated by the normal gait generating means (seventh implementation). 
[0035] Altematively it Is preferable that: the desired gait is generated by separately generating gaits for predeter- 
mined periods, correlation data is previously created for a plurality of kinds of normal gait parameters, the correlation 
data representing a relationship between a nomial gait initial state and the normal gait parameters, the normal gait 

55 Initial state including an initial value of the vertical position of the total center-of-gravity or body of the robot moving 
with a normal gait which is a virtual cyclic gait following a current time gait which is a desired gait for a predetermined 
penod to be newly generated, and the normal gait parameters including a parameter which defines a normal gait's 
desired trajectory of the vertical component of the translation floor reaction force applied to the robot, the vertical 
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component of the total center-of-gravity acceleration of the robot or the vertical component of the body acceleration of 
the robot; the gait generation device further comprises normal gait's initial state determining means that, when gener- 
ating the current time gait, determines, based on the correlation data, the nonnal gait's initial state concerning the 
normal gait following the current time gait from the normal gait parameters set in accordance with required parameters 

5 of the current time gait; and the desired vertical component trajectory determining means determines the desired tra- 
jectory using the normal gait's initial state determined by the normal gait's initial slate determining means in such a 
manner that the verlical position trajectory of the total center-of-gravity or body of the robot moving with the current 
time gait is continuous with or close to the vertical position trajectory of the total center-of-gravity or body of the robot 
moving with the normal gait (eighth implementation). 

10 [0036] According to the seventh or eighth implementation, the desired trajectory of the translation floor reaction force 
(or the like) vertical component for the current time gait is determined In such a manner that the total center-of-gravity 
(or the like) vertical position trajectory depending thereon is continuous with or close to the total center-of-gravity (or 
the like) vertical position trajectory for the nonnal gait including the parameters defining the nonnal gait's desired tra- 
jectory of the translation floor reaction force (or the like) vertical component. Thus, a current time gait that makes the 

15 legs of the robot fully stretched or excessively folded (that Is, a current time gait that results in a significant displacement 
of the body position from the supporting leg position^ described in detail later) can be prevented from being generated, 
and a desired gait that allows the robot to move continuously stably can be generated, 

[0037] In the seventh implementation described above, the normal gait is generated each time the current time gait 
Is generated. However, in the eighth implementation, there is no need to generate the normal gait each time the current 

20 time gait is generated, because the correlation data (a map or the like) previously created Is used. Thus, in the eighth 
Implementation, the amount of calculation required for generating the current time gait can be significantly reduced. 
[0038] In the seventh and eighth implementations described above, it is preferable that, if the legged mobile robot 
Is a two-legged mobile robot with two legs, the required parameters of the current time gait used for generating the 
normal gait include a parameter that defines landing positions/postures for two steps of an end portion of a leg of the 

25 two-legged mobile robot and a parameter that defines gait periods for first and second steps (ninth implementation). 
Thus, the determined norma! gait following the current time gait can be in the same mode (walking, running or the like) 
as the current time gait, and the normal gait detennined can be suitable as the gait following the current time gait (that 
is, a gait without divergence). Thus, the current time gait generated can assure the movement stability of the robot 
with reliability. 

30 [0039] Furthennore, in the seventh to ninth implementations described above, It is preferable that at least the normal 

gait parameter that defines a desired position/posture trajectory of an end portion of each leg for the normal gait is 
determined independently of the normal gait's desired trajectory (tenth implementation). According to this implemen- 
tation, as in the case described with reference to the third implementation, the vertical movement of the body in the 
normal gait, that is, the trajectory of the desired vertical position of the body in the normal gait can be detennined more 
35 readily. 

[0040] Furthermore, in the seventh to tenth implementations described above, it Is preferable that the nomial gait's 
desired trajectory Is a trajectory defined so that the average value of the vertical component of the translation floor 
reaction force for the normal gaifs desired trajectory for a period of one cycle of the nomrial gait agrees with the weight 
of the robot (eleventh implementation). Thus, the vertical velocity (velocity in the vertical direction) of the total center 
40 of gravity (or the like) at the start of one cycle of the normal gait can be made to agree with that at the end thereof 
(since the nonnal gait is a cyclic one, the initial and final states (including the position, the posture and the variation 
rates thereof) of one cycle of the normal gait have to be the same, as described in detail later). 

[0041] Furthermore, in the seventh to eleventh Implementations, it is preferable that, if the current time gait and 
normal gait are gaits which alternately repeat a landing period, when at least one leg of the robot is in contact with the 

45 floor, and a floating period, when all the legs float in the air, as in the case of the fourth Implementation described 
above, the normal gait's desired trajectory is determined in such a manner that the vertical component of the translation 
floor reaction force for the normal gait's desired trajectory varies in a convex pattern within the positive value region 
during the landing period and is kept at 0 during the floating period (twelfth implementation). According to this imple- 
mentation, the normal gait can be detennined which repeats the floating period and the landing period and suitably 

50 follows the current time gait. 

[0042] Furthermore, particularly in the seventh implementation described above, it is preferable that the nonnal gait 
generating means determines the total center-of-gravity (or the like) vertical position of the robot for a predetermined 
period in the normal gait based on a geometrical condition concerning displacement of a joint of a leg (thirteenth 
implementation). Similarly, in the eighth implementation described above, it is preferable that, in generating the normal 

55 gait for creating the correlation data, the total center-of-gravity (or the like) vertical position of the robot for a predeter- 
mined period in the normal gait is determined so as to satisfy a predetermined geometrical condition concerning dis- 
placement of a joint of a leg (fourteenth implementation). 

[0043] According to the thirteenth and fourteenth implementations, as in the case described with reference to the 
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fifth implementation, the total center-of-gravity (or the like) vertlcaf position can be determined so that each leg is 
prevented from being fully stretched at the timings when the leg tends to be fully stretched, such as in the vicinities of 
the instants of landing and taking off the floor (corresponding to the predetemiined period) in the normal gait. 
[0044] Furthermore, in the seventh to fourteenth implementations described above, it is preferable that the desired 

5 vertical component trajectory determining means determines the desired trajectory in such a manner That the venlcal 
position of the tola! cenler-of-gravily or body of the robot and a vertical velocity of the total cenler-of-gravily or body of 
the robot al the end time of the current lime gait satisfy a predetermined relationship with the initial stale of the normal 
gait (for example, the vertical position and velocity of the total center of gravity at the end of the current time gait agree 
with initial ones for the normal gait) (fifteenth implementation). According to this implementation, the desired trajectory 

fo of the translation floor reaction force (or the like) vertical component can be determined which can make the vertical 
position of the total center-of-gravlty or body of the robot and the vertical velocity of the total conter-of -gravity or body 
of the robot continuous with or close to those of the normal gait. 

[0045] Furthermore, in the seventh to fifteenth implementations, different dynamics models may be used to generate 
the current time gait and the normal gait (sixteenth implementation). That is, as described later, the normal gait is a 
^5 virtual gait for prescribing the final state of the current time gait and is not intended for the robot to actually move. Thus, 

different dynamics models can be used for the normal gait and the current time gait. For example, if the dynamics 
model used for generating the normal gait is simpler than the model used for generating the current time gait, the 
amount of calculation required for generating the normal gait can be reduced. 

[0046] According to the present invention (the first to sixteenth implementations thereof), when the desired trajectory 
20 determined by the desired vertical component trajectory determining means is a desired trajectory of the vertical com- 
ponent of the translation floor reaction force or vertical component of the total center-of-gravity acceleration, a desired 
verticai position trajectory of the body can be determined by configuring the desired vertical position determining means 
as described below, for example. 

[0047] In a first configuration, the desired vertical position determining means comprises desired total center-of- 
25 gravity vertical position determining means and desired body vertical position detemnlning means, the desired total 

center-of-gravity vertical position detemriining means successively detenriining an instantaneous value of the desired 
total center-of-gravity vertical position of the robot using a value derived by second-order integration successively from 
an instantaneous value of the vertical component of the translation floor reaction force or vertical component of the 
total center-of-gravity acceleration of the desired trajectory, and the desired body vertical position determining means 
30 successively determining an instantaneous value of the desired vertical position of the body of the robot using at least 
a robot's model representing a relationship between the position/posture of a predetermined part, Including the body, 
of the robot and the vertical position of the total center-of-gravity of the robot and an instantaneous value of the vertical 
position of the desired total center-of-gravity of the robot (seventeenth implementation). 

[0048] Furthermore, in another configuration, the desired vertical position determining means comprises desired 
•35 total center-of-gravity vertical position determining means and desired body vertical position determining means for 
successively detennining an instantaneous value of the desired vertical position of the body of the robot, the desired 
total center-of-gravity vertical position determining means successively determining an instantaneous value of the 
desired total center-of-gravity vertical position of the robot using a value derived by second-order integration succes- 
sively from an instantaneous value of the vertical component of the translation floor reaction force or vertical component 
40 of the total center-of-gravity acceleration of the desired trajectory, and the desired body vertical position determining 
means using at least a last time instantaneous value of the desired vertical position of the body of the robot and a 
model which represents a relationship between the position/posture of a predetemiined part, including the body of the 
robot and the vertical position of the total center-of-gravity position of the robot, thereby calculating an instantaneous 
value of the vertical position of the total center-of-gravity of the model and determining a current time instantaneous 
45 value of the desired vertical position of the body based on the difference between the calculated instantaneous value 
of the total center-of-gravity position of the model and the instantaneous value of the desired total center-of-gravity 
vertical position (eighteenth implementation), 

[0049] In the seventeenth implementation described above, since the instantaneous value of the desired total center- 
of-gravity vertical position detemnined by the desired trajectory of the vertical component of the translation floor reaction 

50 force or vertical component of the total center-of-gravity acceleration and the model representing a relationship between 
the position/posture of a predetermined part Including the body (body, leg or the like) of the robot and the total center- 
of-gravity vertical position of the robot are used, the instantaneous value of the desired vertical position of the body 
can be successively determined. Thus, the desired movement of the body in the vertical direction is determined. 
[0050] In the eighteenth implementation descnbed above, the instantaneous value of the desired total center-of- 

55 gravity vertical position is successively detemnined as a required value of the total center-of-gravity vertical position of 
the robot for the desired trajectory of the vertical component of the translation floor reaction force or total center-of- 
gravity acceleration vertical component, and the last time value of the desired vertical position of the body previously 
determined (that is, the value determined in the immediately preceding calculation cycle) and the model representing 
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a relationship between the position/posture of a predetermined part (body, leg or the like) of the robot and the vertical 
position of the total center of gravity of the robot are used, thereby successively calculating the instantaneous value 
of the total center-of-gravity vertical position of the model (referred to as a model's total center-of-gravity vertical po- 
sition, hereinafter). Since the current instantaneous value of the desired vertical position of the body is determined 
5 based on the difference between the instantaneous value of the desired total center-of-gravity vertical position and the 
instantaneous value of the model's total cenler-of-graviLy vertical position, the desired vertical position of the body can 
be successively determined by a feedback control law depending on the difference. Thus, the desired movement of 
t\-\e body in the vertical direction is determined. 

[0051] In the eighteenth implementation described above, it is preferable that the gait generation device comprises 

10 means for successively determining a provisional desired vertical position of the body of the robot using at least the 
vertical position of the desired total center-of-gravity detemilned by the desired total center-of-gravity vertical position 
determining means and a second model representing a relationship between the position/posture of a predetermined 
part, including the body, of the robot and the vertical position of the total center-of-gravity of the robot, and the desired 
body vertical position determining means determines a current time value of the desired vertical position of the body 

15 by correcting the last time value of the desired vertical position of the body based on the difference and the provisional 
desired vertical position (nineteenth implementation). According to this implementation, the current time value of the 
desired vertical position of the body is successively determined by correcting the last time value of the desired vertical 
position of the body based on the feedback component depending on the difference and a feedforward component 
depending on the provisional desired vertical position of the body determined using the second model. As a result, the 

20 trajectory of the desired vertical position of the body can be determined so that the trajectory of the model's total center- 
of-gravity vertical position follows the trajectory of the desired total center-of-gravity vertical position with a higher 
precision. In the nineteenth implementation, the second model may be a relatively simple model (for example, a model 
having one corresponding material particle for each of the body and the legs). The model used for determining the 
model's total center-of-gravity vertical position is preferably a more precise one. 

25 [0052] It is preferable that a control device for controlling operation of a legged mobile robot In accordance with a 
desired gait generated by a gait generation device according to the present invention (the first to nineteenth imple- 
mentations) (that is, a control device for a legged mobile robot according to the present invention) comprises compliance 
control means for correcting the position and posture of an end portion of each leg based on a deviation of an actual 
floor reaction force applied to the end portion of the leg from a desired floor reaction force for the end portion of the 

30 leg determined for the desired gait (twentieth implementation). 

[0053] That is, due to the correction of the position and posture of the end portion of the leg by the compliance control 
means, an actual translation floor reaction force's v^ertical component actually appliea to the end portion of the leg can 
more precisely follow the vertical component of the translation floor reaction force (referred to as a desired translation 
floor reaction force's vertical component, hereinafter) determined depending on the desired trajectory of the translation 

35 floor reaction force (or the like) vertical component determined by the gait generation device. In this case, since the 
gait generation device according to the present invention can preferentially set the desired translation floor reaction 
force's vertical component in a pattern suitable for the gait mode, the desired translation floor reaction force's vertical 
component can be followed more precisely, so that the robot can be made to move with a desired gait (a walking gait, 
running gait or the like) without application of an excessive load to the legs of the robot. For example, even If the leg 

40 accidentally lands due to the geometry of the floor or the like during a period in which the desired translation floor 
reaction force's vertical component is 0, the position and posture of the end portion of the leg is corrected so that the 
leg takes off the floor under the control of the compliance control means. Thus, the robot can move while providing the 
vertical component of the translation floor reaction force suitable for the gait mode as precisely as possible. 

45 Brief Description of the Drawings 

[0054] Figure 1 is a schematic diagram showing awhole arrangement of a two-legged mobile robot, which Is a legged 
mobile robot according to an embodiment of the present invention; Figure 2 is a side view of a foot portion of each leg 
of the robot shown in Figure 1 ; Figure 3 is a block diagram showing a control unit provided in the robot shown in Figure 

50 1; Figure 4 is a block diagram showing a functional arrangement of the control unit shown In Figure 3; Figure 5 is a 
diagram for illustrating a running gait for the robot shown in Figure 1 ; Figure 6 is a graph showing an example of setting 
of a desired floor reaction force's vertical component; Figure 7 is a graph showing an example of setting of a desired 
ZMP; Figures 8 and 9 are diagrams for illustrating movement modes (body translation mode and body rotation mode, 
respectively) of the robot; and Figures 1 0 and 11 are diagrams for illustrating dynamics models of the robot. Figure 12 

55 is a flowchart showing main routine process perfonned by the gait generation device provided in the control unit shown 
in Figure 3; Figure 13 is a diagram illustrating a divergence state of the body position of the robot; Figure 14 is a 
flowchart for illustrating subroutine process in the flowchart shown in Figure 12; Figure 15 is a diagram illustrating a 
relationship between foot landing positions/postures in a normal gait and coordinate systems; Figure 16 Is a graph 
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showing an example of setting of a desired floor reaction force's vertical component for tlie normal gait; Figure 17 is 
a graph showing an example of setting of a floor reaction force's horizontal component allowable range for the normal 
gait; Figure 18 is a graph showing an example of setting of a desired ZMP for the normal gait; Figure 19 is a flowchart 
showing subroutine process in the flowchart shown in Figure 12: Figure 20 is a flowchart showing subroutine process 

5 In the flowchart shown in Figure 19; Figure 21 is a flowchart showing subroutine process in the flowchart shown in 
Figure 20; and Figure 22 is a flowcharl showing subroutine process in the flowcharl shown in Figure 21 . Figures 23 to 
30 are graphs for illustrating essential process in Ihe flowcharl shown in Figure 22; Figure 31 is a diagram showing an 
example of a trajectory of the body position for the normal gait; Figure 32 is a flowchart showing subroutine process 
in the flowchart shown in Figure 12; Figure 33 is a graph showing an example of setting of the floor reaction force's 

10 horizontal component allowable range for a current time gait ; Figure 34 is a flowchart showing subroutine process in 
the flowchart shown in Figure 1 2; Figure 35 is a flowchart showing subroutine process in the flowchart shown in Figure 
34; Figure 36 is a flowchart showing subroutine process in the flowchart shown in Figure 35; Figure 37 is a flowchart 
showing subroutine process in the flowchart shown in Figure 36; and Figure 38 Is a graph for illustrating essential 
process in the flowchart shown in Figure 37. Figure 39 is a graph showing a relationship between body horizontal 

15 position trajectories in the current time gait and the normal gait; Figure 40 is a diagram showing another example of 
modes of movements of the robot; Figure 41 is a graph showing a relationship between a body horizontal position and 
a body horizontal velocity at an end of the current time gait converging to the normal gait; Figure 42 is a diagram 
showing an example of setting of a desired floor reaction force vertical component in a walking gait; Figures 43 and 
44 are flowcharts illustrating processes for setting a desired floor reaction force vertical component in a walking gait; 

20 Figure 45 is a diagram showing a process concerning switching between a walking gait and a running gait; Figures 46 
and 47 are flowcharts illustrating methods for determining a desired body vertical position; Figure 48 is a diagram 
showing a relationship between a body vertical position and a floor reaction force vertical component in a running gait; 
and Figure 49 is a diagram showing a relationship between a body vertical position and a floor reaction force vertical 
component in a walking gait 

25 

Best Mode for Carrying Out the Invention 

[0055] In the following, one-embodiment of a gait generation device and a control device for a legged mobile robot 
according to the present invention will be described with reference to the drawings. In the embodiments of the present 
30 invention, a two-legged mobile robot is taken as an example of the legged mobile robot. 

[0056] Figure 1 is a schematic diagram showing awhole arrangement of a two-legged mobile robot, which is a legged 
mobile robot which uses a gait generation device and a control device according to an embodiment of the present 
invention. 

[0057] As shown in the drawing, a two-legged mobile robot (referred to as a robot, hereinafter) 1 comprises a pair 
35 of left and right legs (leg links) 2, 2 extending downward from a body 24. The legs 2, 2 have the same construction 
and each have six joints. In the order of increasing distance from the body 24, the six joints include a hip (waist) joint 
10R (10L) for convolution (rotation) (rotation in the yaw direction with respect to the body 24), a hip (waist) joint 12R 
(12L) for rotation In the roll direction (about the X axis), a hip (waist) joint 14R (14L) for rotation in the pitch direction 
(about the Y axis), a knee joint 16R (16L) for rotation in the pitch direction, an ankle joint 18R (18L) for rotation in the 
40 pitch direction, and an ankle joint 20R (20L) for rotation in the roll direction. Reference symbols R and L indicate the 
right leg and the left leg, respectively. 

[0058] Under the two ankle joints 18R(L) and20R(L) of each leg 2, afoot (foot portion) 22R(L) which constitutes the 
end portion of the leg 2 is attached. The body (base body) 24 is mounted on the top of the two legs 2, 2 via the hip 
joints 10R, 1 OL, 12R. 12L, 14R and 14L (three joints for each leg 2). The body 24 houses a control unit 26 and the 
45 like, which will be described in detail later. In Figure 1 , for the convenience of illustration, the control unit 26 is shown 
as being external to the body 24. 

[0059] In each leg 2 configured as described above, the hip joint (or waist joint) is composed of the joints 10R(L), 
12R(L) and 14R(L), and the knee joint Is composed of the joint 16R(L), and the foot joint (ankle joint) is composed of 
the joints 1 8R(L) and 20R(L). The hip joint and the knee joint are connected to each other by a thigh link 28R(L), and 

50 the knee joint and the foot joint are connected to each other by a crus link 30R(L). 

[0060] Although not shown, a pair of left and right arms are attached to the upper part of the body 24 on either side 
thereof, and a head is mounted on the top of the body 24. Detailed description of the anns and the head is omitted in 
this specification, because they have no direct concern with the essence of the present invention. However, each arm 
has a plurality of joints and can make movements, such as back and forth swing with respect to the body 24, by the 

55 action the joints 

[0061] Configuring each leg 2 as described above provides the foot 22R(L) of the leg 2 with six degrees of freedom 
with respect to the body 24. When the robot 1 moves, desired movements of the feet 22R and 22L can be realized by 
driving the twelve joints of the two legs 2, 2 (6*2=12) to appropriate angles (in this specification, the symbol represents 
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multiplication of scalar operation or outer product of vector operation). Thus, the robot 1 can move arbitrarily in a three- 
dinnensional space, 

[0O62] The "position" and "velocity" of the body 24 described later in this specification refer to the position of a pre- 
determined part of the body 24, specifically, a predetermined representative point of the body 24 (for example, a mid- 

5 point between the left and right hip joints) and the movement velocity of the point. Similarly, the "position" and "velocity" 
of each foot 22R(22L) refer to the position of a predetermined representative point of the foot 22R (22L) and the 
movement velocity of the point. In this embodiment, for example, the representative point of each fool 22R (22L) is set 
in the sole surface of the foot 22R (22L) (more specifically, a point at which a perpendicular line extending from the 
center of the ankle joints of each leg 2 to the sole surface of the foot 22R (22L) intersects with the sole surface, for 

10 example). 

[0063] As shown in Figure 1 , each leg 2 has a well-known six-axis force sensor 34 disposed below the ankle joints 
18R(L) and 20R(L) and interposed between the ankle joints and the foot 22R(L). The six-axis force sensor 34 detects 
the presence of landing of the foot 22R (22L) of the leg 2, the floor reaction force (floor-contact load) applied to the leg 
2, and the like. The six axis force sensor outputs, to the control unit 26, detection signals of three directional components 

15 Fx, Fy and Fz of the translation force of the floor reaction force and three directional components Mx, My and Mz of 
the moment thereof. In addition, the body 24 has an inclination sensor 36 for detecting the inclination (posture angle) 
of the body 24 with respect to the Z axis (vertical direction (direction of gravity)) and the angular velocity thereof, and 
the inclination sensor 36 outputs the detection signals to the control unit 26. In addition, although not shown in detail, 
each joint in the robot 1 has an electric motor 32 for driving it (see Figure 3) and an encoder (rotary encoder) 33 (see 

20 Figure 3) for detecting the rotation amount of the electric motor 32 (rotation angle of the Joint). The encoder 33 outputs 
the detection signal to the control unit 26. 

[0064] As shown in Figure 2, a spring mechanism 38 is provided above each foot 22R(L) and between the foot 22R 
(L) and the six-axis force sensor 34, and a foot sole elastic member 40 made of a rubber or the like is attached to the 
foot sole (bottom surface) of each foot 22R(L). The spring mechanism 38 and the foot sole elastic member 40 constitute 

25 a compliance mechanism 42. Specifically, the spring mechanism 38 comprises a rectangular guide member (not shown) 
mounted on the upper surface of the foot 22R(L) and a piston member (not shown) mounted on the same side as the 
ankle joint 1 8R(L) (the ankle Joint 20R(L) is not shown in Figure 2) and the six-axis force sensor 34 and housed in the 
guide member in such a manner that the piston merhber can slightly move in the guide member due to an elastic 
member (such as a rubber or spring). 

30 [0065] The foot 22R(L) shown by the solid line in Figure 2 is in a state where no floor reaction force is applied to the 
foot. When a floor reaction force is applied to the leg 2, the spring mechanism 38 and the foot sole elastic member 40 
of the compliance mechanism 42 are distorted, thereby shifting the foot 22R(L) to a position/posture as indicated by 
the dotted line in Figure 2. This configuration of the compliance mechanism 42 is important not only for reducing the 
landing impact but also for increasing the controllability of the robot 1 . Detailed description of the compliance mechanism 

35 is omitted herein, because it is described in detail in Japanese Patent Laid-Open No. 5-305584 previously proposed 
by the applicants. 

[0066] Furthermore, although not shown in Figure 1 , a Joystick (manipulator) 44 (see Figure 3) for manipulating the 
robot 1 is provided external to the robot 1 . A request concerning the gait of the robot 1 , such as a request to turn the 
robot 1 moving straight ahead, can be entered to the control unit 26 as required by manipulating the joystick 44. In this 
40 case, requests that can be entered include those concerning the gait modes (walking gait, running gait or the like) of 
the robot 1 in motion, the landing position/posture or landing time of a free leg, and command data for prescribing the 
landing position/posture and landing time (for example, the movement direction of the robot 1 , the movement velocity 
thereof), 

[0067] Figure 3 is a block diagram showing an arrangement of the control unit 26. The control unit 26 is constituted 
45 by a microcomputer and comprises a first calculation unit 60 and a second calculation unit 62 (which constitute a CPU), 
an A/D converter 50, a counter 56, a D/A converter 66, a RAM 54, a ROM 64 and a bus line 52 for data transmission 
among these components. In the control unit 26, the output signals from the six-axis force sensors 34 of the legs 2, 
the inclination sensor 36, the joystick 44 and the like are converted into digital values in the A/D converter 50 and then 
input to the RAM 54 via the bus line 52, Besides, the outputs from the encoders 33 (rotary encoders) at the Joints of 
50 the robot 1 are input to the RAM 54 via the counter 56. 

[0068] As described later, the first calculation unit 60 generates a desired gait, calculates a Joint angle displacement 
command (command value of the displacement angle of each joint or the rotation angle of each electric motor 32) and 
transmits the command to the RAM 54. The second calculation unit 62 reads, from the RAM 54, the joint angle dis- 
placement command and the measurement value of the Joint angle indicated by the output signal of each encoder 33, 
55 calculates the operating amount of each Joint to be driven and outputs the operating amount data to the electric motor 
32 that drives the joint via the D/A converter 66 and a servo amplifier 32a. 

[0069] Figure 4 is a block diagram showing a whole functional arrangement of the gait generation device and the 
control device of the robot 1 according to this embodiment. All the parts in Figure 4 except for the part designated as 
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an "actual robot" are implemented by the functions performed by the control unit 26 (functions performed mainly by 
the first calculation unit 60 and the second calculation unit 62). In the following description, the reference symbols R 
and L wilt be omitted if there is no need to discriminate between the left and right legs 2. 

[0070] The control unit 26 has a gait generation device 100 that generates and outputs a desired gait flexibly and in 
5 real time as described later. The gait generation device 1 00 has functions that implement means of the gait generation 
device according to the present invention. The desired gait output from the gait generation device 100 includes a 
desired body position/posture trajectory (trajectories of a desired position and a desired posture of the body 24), a 
desired foot position/posture trajectory (trajectories of a desired position and a desired posture of each foot 22), a 
desired arm posture trajectory (a trajectory of a desired posture of each ann), a desired total floor reaction force central 
10 point trajectory (a desired ZMP trajectoty), and a desired total floor reaction force trajectory. If the body 24 has a 
movable member other than the legs 2 and the arms, a desired position/posture trajectory of the movable member is 
added to the desired gait. 

[0071] Here, the term "trajectory" means a time- varying pattern (time-sehes pattern), and is sometimes referred to 

also as a "pattern" in the following description. In addition, the term "posture" means a spatial orientation of each 
15 component. Specifically, for example, the body posture is represented by the inclination angle (posture angle) of the 
body 24 with respect to the Z axis (vertical axis) in the roll direction (about the X axis) and the inclination angle (posture 
angle) of the body 24 with respect to the Z axis in the pitch direction (about the Y axis), and the foot posture is repre- 
sented by the spatial azimuth angles of two axes set fixedly to each foot 22. In this specification, the body posture is 
sometimes referred to also as a body posture angle. 
20 [0072] In the following description, the term "desired" will often be omitted as far as it causes no misunderstanding. 
The components of the gait other than those related to the floor reaction force, that is, the components related to the 
movement of the robot 1 , such as the foot position/posture and the body position/posture, are collectively referred to 
as a "movement". Furthermore, the floor reaction force applied to each foot 22 (the floor reaction force composed of 
the translation force and the moment) is referred to as an "each-foot floor reaction force", and the resultant force of 
25 the "each-foot floor reaction forces" applied to all (two) the feet 22R and 22L of the robot 1 is referred to as a "total 
floor reaction force". However, in the following description, there is made little mention of the each-foot floor reaction 
force, and therefore, the "floor reaction force" means the same as the "total floor reaction force" unless otherwise 
specified. 

[0073] In general, the desired floor reaction force is represented by the point of application, and the translation force 
30 and the moment applied to the point. The point of application can be set arbitrarily, so that one desired floor reaction 
force can be represented in an Infinite number of ways. However, if the desired floor reaction force Is represented by 
taking the desired floor reaction force central point (desired position of the central point of the total floor reaction force) 
as the point of application, the moment components of the desired floor reaction force are 0 except for the vertical 
component (the moment about the vertical axis (Z axis)). In other words, the horizontal moment components of the 
35 desired floor reaction force about the desired floor reaction force centra! point (the moments about the horizontal axes 
(X axis and Y axis)) are 0. 

[0074] Here, in a gait which satisfies the dynamical equilibrium condition, the Zf^P (the point where the moments 
applied by the resultant force of the inertial force and gravity applied to the point are 0 except for the vertical moment) 
calculated from the desired movement trajectory of the robot 1 agrees with the desired floor reaction force central point. 
40 Therefore, providing the desired floor reaction force central point trajectory means the same as providing the desired 
ZMP trajectory (for more infonnation, see Japanese Patent Application No. 2000-352011 filed by the applicants). 
[0075] Based on such a background, in the specification of Japanese Patent Application No. 2000-35201 1 described 
above, the desired gait Is defined as follows. 

(a) In a broad sense, the desired gait is a set of a desired movement trajectory and a desired floor reaction force 
trajectory for a period of one or more steps. 

(b) In a narrow sense, the desired gait is a set of a desired movement trajectory and a ZMP trajectory for a period 
of one step. 

(c) A gait series is a connection of several gaits. 

50 

[0076] In walking, when the vertical position of the body 24 (body height) of the robot 1 is determined by the body 
height detennination method previously proposed in Japanese Patent Laid-open No. 10-86080 by the applicants, the 
translation floor reaction force's vertical component is determined accordingly. Furthermore, if the body horizontal po- 
sition trajectory of the robot 1 is determined in such a manner that the horizontal component of the moment produced 
55 about the desired ZMP by the resultant force of the inertial force due to the movement with the desired gait and gravity 
is 0, the horizontal component of the translation floor reaction force is also determined. Therefore, in the specification 
of the Japanese Patent Application No. 2000-352011 , the physical value concerning the floor reaction force of the 
desired gait which has to be explicitly set is only the desired ZMP. Therefore, as the definition of the desired gait In a 
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narrow sense, the definition (b) described above is sufficient. On the other hand, in a running gait of the robot 1 described 
in this embodiment (details thereof will be described later), the floor reaction force's vertical component (the translation 
floor reaction force's verticel component) is also essential in controlling the robot. Therefore, in the present invention, 
a desired trajectory of the floor reaction force's vertical component is explicitly set, and then, trajectories of the desired 
5 body's vertical position and the like of the robot 1 are determined. Thus, In this specification, as a definition of the 
desired gait in a narrow sense, (b') described below is used, (b') in a narrow sense, the desired gait is a set of a desired 
movement trajectory and a desired ZMP trajectory thereof and a desired translation floor reaction force's vertical com- 
ponent trajectory for a period of one step. 

[0077] In this specification, to be readily understood, the term "desired gait" is used to mean the desired gait in the 
fo narrow sense of the above (b') unless otherwise specified. In this case, the term "one step" in the desired gait is used 
to mean a leg operation starting with landing of one log 2 of the robot 1 and ending with landing of the other leg 2. Note 
that, in the following description, the "floor reaction force's vertical component" means the "translation floor reaction 
force's vertical component", and the vertical component of the moment of the floor reaction force (the component about 
the vertical axis) is discriminated from the "floor reaction force's vertical component" by using the term "moment". 
15 Similarly, the "floor reaction force's horizontal component" means the "translation floor reaction force's horizontal com- 
ponent". 

[0078] Furthermore, of course, a "two-leg supporting period" refers to a period in which the two legs 2, 2 support the 
weight of the robot 1 , a "one-leg supporting period" refers to a period in which either one of the legs 2, 2 supports the 
weight of the robot 1 , a "floating period" refers to a period in which both the legs 2, 2 are away from the floor (floating 

20 in the air). The leg 2 that doesn't support the weight of the robot 1 during the one-leg supporting period is referred to 
as a "free leg". In the running gait described in this embodiment, there is no two-leg supporting period, and the one- 
leg supporting periods (landing periods) and the floating periods are repeated alternately. In this case, during the 
floating period, both the two legs 2, 2 don't support the weight of the robot 1 . However, the leg 2 that has been a free 
leg during the one-leg supporting period immediately preceding the floating period Is referred to as a free leg during 

25 the floating period, and the leg 2 that has been a supporting leg during the one-leg supporting period immediately 
preceding the floating period is referred to as a supporting leg during the floating period. 

[0079] With the running gait shown in Figure 5 as an example, a desired gait generated by the gait generation device 
100 will be described schematically. Here, other definitions and details concerning the gait are described in Japanese 
Patent Laid-Open No. 1 0-86081 previously proposed by the applicants, and therefore, the following is descriptions that 

30 are not made in Japanese Patent Laid-Open No. 1 0-86081 . 

[0080] First, the running gait shown in Figure 5 will be described. This running gait is one similar to a typical running 
gait of a human being. In this running gait, the one-leg supporting periods in which the foot 22 of only one of the left 
and right legs 2 of the robot 1 (supporting leg) lands (is In contact with the floor) and the floating periods in which both 
the legs 2, 2 float in the air are repeated alternately. The first state in Figure 5 is a state (initial state) of the robot 1 at 

35 the start of a one-leg supporting period, the second state is a stale thereof at the middle of the one-leg supporting 
period, the third state is a state thereof at the start of a floating period following the one-leg supporting period (the end 
of the one-leg supporting period), the fourth state is a state thereof at the middle of the floating period, and the fifth 
state is a state thereof at the end of the floating period (the start of the next one-leg supporting period). 
[0081] In this running gait, as shown in the first state in Figure 5, the robot 1 lands on the heel of the foot 22 of the 

^o supporting log (the leading leg 2 of the robot 1 in the movement direction) at the start of the one-leg supporting period. 
Then, as shown in the second state in Figure 5, substantially the whole surface of the sole of the landing foot 22 (foot 
22 of the supporting leg) of the robot 1 comes into contact with the floor, and then, as shown in the third state in Figure 
5, the robot 1 Jumps into the air by kicking the floor on the toe of the foot 22 of the supporting leg (foot 22 of the trailing 
leg 2 in the movement direction of the robot 1 in the third state shown in Figure 5). This is the time when the one-leg 

45 supporting period ends and the floating period starts. During the one-leg supporting period, the free leg, which is located 
reanA/ard of the supporting leg at the start of the one-leg supporting period as shown in the first state in Figure 5, is 
swung forward of the supporting leg toward a next expected landing position, as shown in the second and third states 
in Figure 5. Then, after the floating period shown as the fourth state in Figure 5, the robot 1 lands on the heel of the 
foot 22 of the free leg (leg 2 that has been the free leg during the one-leg supporting period immediately preceding the 

50 floating period), and then, the next one-leg supporting period starts, 

[0082] With reference to the running gait in Figure 5, a desired gait generated by the gait generation device 1 00 will 
be described schematically. As described in detail later, when the gait generation device 100 generates a desired gait, 
basic required values (required parameters) for desired gait generation, such as landing position/posture (expected 
landing position/posture) and landing time (expected landing time) of the foot 22 of the free leg, are supplied to the 

55 gait generation device 1 00 via a required operation of the joystick 44 or the like. The gait generation device 1 00 gen- 
erates the desired gait using the required parameters. More specifically, based on the required parameters, the gait 
generation device 100 detennines parameters (referred to as gait parameters) that define some of the components of 
the desired gait, such as the desired foot position/posture trajectory and the desired floor reaction force's vertical 
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component trajectory for the desired gait, and then successively deternnines instantaneous values of the desired gait 
using the gait parameters, thereby generating a time-series pattern of the desired gait. 

[0083] In this case, the desired foot position/posture trajectory (more specifically, desired trajectories of spatial com- 
ponents (such as X axis component) of the position and posture of the foot) is generated for each foot 22 using the 

5 finite duration settling filter proposed by the applicants in Japanese Patent No. 3233450, for example. The finite duration 
settling filler is a series conneclion of plural (three or more, in this embodiment) stages of first-order delay filters of a 
variable lime conslanl. thai is, fillers having a transmission function represented as 1/(1 +ts) where t is a variable lime 
constant (this filter is referred to as a unit filter, hereinafter). And, the finite duration settling fitter can generate and 
output a trajectory that reaches to a specified value at a desired specified time. In this case, the time constant x of the 

10 unit filter of each stage is successively set in a variable manner based on the remaining time before the specified time 
after the definite duration settling filter starts generating the output. More specifically, as the remaining time decreases, 
the value of t decreases from a predetermined init iai value (>0), and finally, at the specified time when the remaining 
time is 0, the value of x becomes 0. And, a step input having a height depending on the specified value (more specifically, 
the amount of variation of, the output of the definite duration settling filter from the initial value to the specified value) 

15 is given to the definite duration settling filter. Such a definite duration settling filter can not only generate such an output 
that reaches to the specified value at the specified time but also have the variation rate of the output thereof being 0 
or substantially 0 at the specified time. In particular, if the unit filters are interconnected in three or more stages (three 
stages are enough), the variation acceleration (the differential value of the variation rate) of the output of the definite 
duration settling filter can be 0 or substantially 0. 

20 [0084] The generation of the foot position/posture trajectory (the position/posture trajectory of the foot 22 from a 
landing thereof to the next landing thereof) using such a definite duration settling filter is conducted in the following 
manner, for example. For example, the desired foot position trajectory in the X axis direction (back-and-forth direction) 
is generated as follows. That is, the height of the step input to the definite duration settling filter is determined depending 
on the X-axis directional position of the next expected landing position of each foot 22 (more specifically, the amount 

25 of variation (displacement) in the X axis direction of the next expected landing position with respect to the preceding 
landing position, this being equivalent to the specified value) which is determined by the required parameters, and the 
time constant x is initialized to a predetermined initial value. Then, the detennined step input is given to the definite 
duration settling filter, and generation of the trajectory of the X-axis directional position of the foot 22 is started. During 
the trajectory generation, the time constant x is successively set in a variable manner so as to decrease from the initial 

30 value to 0 by the expected landing time of the foot 22 (which Is equivalent to the specified time). In this way, the trajectory 
of the position of the foot 22 in the X axis direction that reaches to the expected landing position at the expected landing 
time is generated. 

[0085] Besides, the desired foot position trajectory in the Z axis direction (vertical direction) is generated In the fol- 
lowing manner, for example. Specifically, first, based on the next expected landing position and expected landing time 

35 of the fool 22, the Z-axis directional position of the fool 22 at the time when the foot 22 reaches the maximum height 
(vertical position) (referred to as a highest position, hereinafter) and the time required to reach the highest position are 
detennined. Then, according to the highest position (which is equivalent to the specified value), the height of the step 
input to the definite duration settling filter is determined, and the time constant x is initialized. And then, the determined 
step Input is given to the definite duration settling filter, and the foot position trajectory to the highest position in the Z 

40 axis direction is successively generated. In this regard, the time constant t is successively set in a variable manner so 
as to decrease from the Initial value to 0 by the time when the highest position Is reached (this time being equivalent 
to the specified time). Furthennore, when the generation of the trajectory to the highest position in the Z axis direction 
is completed, the time constant t is initialized, a step input of the polarity opposite to that of the step input having been 
used (more specifically, a step input of the opposite polarity having a height depending on the amount of variation in 

45 the Z axis direction from the highest position to the next expected landing position (this being equivalent to the specified 
value)) Is input to the definite duration settling filter, and the foot position trajectory in the Z axis direction from the 
highest position to the expected landing position is successively generated. In this regard, the time constant x Is suc- 
cessively set In a variable manner so as to decrease from the initial value to 0 by the expected landing time of the foot 22 . 
[0086] When generating the foot position trajectory in the Z axis direction, the time constant x may be set in a variable 

50 manner so as to decrease from the Initial value to 0 in a period from the start of the trajectory generation to the expected 
landing time of the foot 22, and the polarity of the step input may be switched to the opposite one at the time when the 
highest position is reached or the time in the vicinity thereof. In this case, although the foot 22 cannot reach to a desired 
highest position with a high precision, the foot 22 can reach the expected landing position at the expected landing time 
without problems. 

55 [0087] The foot posture trajectory can be generated using the definite duration settling filter as with the foot position 
trajectory described above. In this case, as for a spatial component of the foot posture whose posture angle variation 
is monotonic (monotonically increasing or monotonlcally decreasing), the foot posture trajectory can be generated In 
the same manner as the foot position trajectory in the X axis direction described above. Besides, as for a spatial 
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component of the foot posture whose posture angle variation has a maximum value or minimum value, the foot posture 
trajectory can be generated in the same manner as the foot position trajectory in the Z axis direction described above. 
[0088] Here, the desired foot position/posture trajectory generated using the definite duration settling filter as de- 
scribed above is the desired position/posture trajectory of each foot 22 in a supporting leg coordinate system fixed on 

5 the floor surface described later. 

[0089] The desired fool position/posLure trajectory generated as described above is configured so that the position 
of each fool 22 slarls moving by gradually accelerating from the initial floor-contact state (the state at the start time in 
the desired gait) toward the expected landing position. In addition, the desired foot position/posture trajectory is con- 
figured so that the variation rate of the foot position is gradually reduced and finally reaches to 0 or substantially 0 at 

10 the expected landing time, and the foot reaches to the expected landing position at the expected landing time and 
stops moving. Thus, at the instant when each foot 22 lands, the velocity thereof with respect to the floor (the variation 
rate of the position of the foot 22 in the supporting leg coordinate system fixed on the floor) is 0 or substantially 0. 
Therefore, if the foot lands from a state where both the legs 2, 2 float in the air (state during the floating period) in the 
running gait, it is subject to a reduced landing impact. 

15 [0090] In the running gait, the vertical velocity of the body 24 is downward in the later half of the floating period 
because of gravity applied to the robot 1 , and the vertical velocity remains downward at the time of landing. Therefore, 
if the desired foot position/posture trajectory is generated in such a manner that the velocity of the foot 22 with respect 
to the floor at the instant of landing is 0 or substantially 0, and the desired position/posture trajectory of the body 24 is 
generated so as to satisfy the dynamical equilibrium condition as described later the relative velocity of the foot 22 of 

20 the free leg with respect to the body 24 is upward at the time immediately before landing. That is, at the instant of 
landing in the running gait, the desired gait of the robot 1 is one in which the robot 1 lands at the floor while retracting 
the free leg 22 to the body 24. In other words, in the desired gait In this embodiment, the robot 1 lands by retracting 
the foot 22 of the free leg toward the body 24 so that the foot 22 has a velocity with respect to the floor of 0 or substantially 
0 at the instant of landing. Thus, the landing impact is reduced and prevented from being excessive. 

25 [0091] In this embodiment, since the definite duration settling filter is a series connection of three or more (three, for 
example) stages of unit filters, the velocity of each foot 22 (variation rate of the position of the foot) is reduced to 0 or 
substantially 0 by the expected landing time, and the acceleration of each foot 22 is also reduced to 0 or substantially 
0 at the expected landing time, so that the foot 22 stops moving. That is, the acceleration with respect to the floor is 
also 0 or substantially 0 at the Instarit of landing. Thus, the landing impact is further reduced. In particular, even if the 

30 actual landing time of the robot 1 varies from the desired landing time, the Impact doesn't increase signlllcantly. Inci- 
dentally, in order to simply make the velocity of each foot 22 with respect to the floor 0 or substantially 0 at the expected 
landing time, the definite duration settling filter may be composed of two stages of unit filters. However, in this case, 
the acceleration of each foot 22 is not 0 at the expected landing time typically 

[0092] Here, the foot posture continues to change after the foot 22 lands on the heel at the expected landing time 
35 until substantially the whole surface of the sole of the fool 22 comes into contact with the floor. Therefore, the foot 
posture trajectory is generated using the definite duration settling filter by setting the time when substantially the whole 
surface of the sole of the foot 22 comes into contact with the floor as the specified time. 

[0093] Furthermore, while the definite duration settling filter is used to generate the foot position trajectory in this 
embodiment, the desired foot position trajectory may be generated using a function, such as a polynomial that is defined 

40 so that the variation rate of the foot position is 0 or substantially 0 (the time differential value of the foot position Is 0) 
at the expected landing time, and the variation acceleration of the foot position (the time differential value of the variation 
rate) is 0 or substantially 0 at the expected landing time. This holds true for the generation of the desired foot posture 
trajectory. However, for generation of the desired foot posture trajectory, the function, such as a polynomial, is defined 
so that the variation rate of the posture of each foot 22 and the variation acceleration thereof are 0 or substantially 0 

45 at the time when substantially the whole surface of the sole of the foot 22 comes into contact with the floor as described 
above. 

[0094] The desired floor reaction force's vertical component trajectory is set as shown in Figure 6, for example. In 
this embodiment, the shape of the desired floor reaction force's vertical component trajectory in the running gait (spe- 
cifically, the shape thereof in the one-leg supporting period) is prescribed to be trapezoidal (protruding in the direction 

50 of the floor reaction force's vertical component increasing). The height of the trapezoid and the times of the apexes of 
the trapezoid are determined as gait parameters (floor reaction force's vertical component trajectory parameters) for 
defining the desired floor reaction force's vertical component trajectory. Here, during the floating period In the running 
gait, the desired floor reaction force's vertical component is constantly set to 0. As in this example, the desired floor 
reaction force's vertical component trajectory is preferably set to be substantially continuous (i.e. not to have discon- 

55 tinuous values). This is intended to make the joints of the robot 1 move smoothly when controlling the floor reaction 
force. Here, the words "substantially continuous" Imply that a trajectory doesn't lose its continuity because of discrete 
values that inevitably occur when a continuous analog trajectory (continuous trajectory in the true sense) is converted 
into a digital trajectory in a discrete-time system. 
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[0095] The desired ZMP trajectory is set as follows. In the running gait shown in Figure 5, the robot 1 lands on the 
heel of the foot 22 of the supporting leg, then jumps into the air by kicking the floor on the toe of the foot 22 of the 
supporting leg, and finally lands on the heel of the foot 22 of the free leg, as described above, Therefore, the desired 
ZMP trajectory during the one-leg supporting period is set so that the desired ZMP is initially positioned at the heel of 

5 the foot 22 of the supporting leg 2, shifted to the longitudinal nnlddle point of the foot 22 In the period in which substantially 
the whole surface of Lhe sole of the fool 22 of the supporting leg is in contact with the floor, and then shifted lo the toe 
of the foot 22 of lhe supporting leg by lhe lime when lhe foot lakes off the floor, as shown in lhe upper part of Figure 
7. Here, the upper part of Figure 7 shows the desired ZMP trajectory in the X axis direction (back and forth direction), 
and the lower part of Figure 7 shows the desired ZMP trajectory in the Y axis direction (sideward direction). As shown 

10 in the lower part of Figure 7, the desired ZMP trajectory in the Y axis direction during the one-leg supporting period is 
set in such a mannerthat the desired ZMP is at the same position as the central point of the ankle joints of the supporting 
leg 2 in the Y axis direction. 

[0096] In the running gait, after the end of the one-leg supporting period, both the legs 2, 2 move away from the floor, 
and the floor reaction force's vertical component becomes 0. When the floor reaction force's vertical component is 0, 

15 that is, in the floating period, the total center of gravity of the robot 1 performs a free-fall movement, and the an angular 
momentum variation about the total center of gravity is zero. At this point, since the moment of the resultant force of 
gravity and the inertial force acting on the robot 1 is 0 at an arbitrary point on the floor, the desired ZMP Is not settled. 
That is, any point on the floorsatisfies thecondition forZMPthat "apoint of application where the hohzontal component 
of the moment produced by the resultant force of gravity and the inertial force is 0". In other words, even if the desired 

20 ZMP is set in an arbitrary point, the dynamical equilibrium condition that the horizontal component of the moment 
applied around the desired ZMP by the resultant force is 0. Therefore, the desired ZMP may be set discontinuously. 
For example, during the floating period, the desired ZMP may be set so as not to move from the desired ZMP position 
at the time when the leg takes off the floor (when the one-leg supporting period ends) and to move discontinuously (in 
a step-like manner) to the desired ZMP position at the time of landing in the end of the floating period. However, in this 

25 embodiment, as shown in the upper part of Figure 7, the X axis-directional position of the desired ZMP trajectory during 
the floating period is adapted to continuously shift from the toe of the foot 22 on the supporting leg side to the landing 
position of the heel of the foot 22 on the free leg side by the time of the next landing of the free leg 2. Furthermore, as 
shown in the lower part of Figure 7, the Y axis-directional position of the desired ZMP trajectory during the floating 
period is adapted to continuously shift from the Y axis-directional position of the center of the ankle joint of the supporting 

30 leg 2 to the Y axis-directional position of the center of the ankle joint of the free leg 2 by the time of the next landing 
of the free leg 2. That is, the desired ZMP trajectory is made continuous (substantially continuous) for the whole period 
of the gait. Further as described later, the desired gait is generated (more specifically, the desired body position/posture 
trajectory is adjusted) in such a manner that the moment (excluding the vertical component) of the resultant force of 
gravity and the inertial force about the desired ZMP becomes zero. 

35 [0097] A reason for making the desired ZMP trajectory continuous will be described below. During the floating period, 
using a precise dynamic model, the moment about the desired ZMP applied by the resultant force of gravity and the 
inertial force becomes 0. and if the desired gait Is generated by setting the desired floor reaction force's vert:ical com- 
ponent to 0, a true value of a moment applied about the origin of a coordinate system (called a global coordinate 
system) fixed to the floor by a resultant force of gravity and an inertial force due to the generated desired gait (which 

-40 means a moment applied about the origin of the coordinate system by a resultant force of gravity and an inertial force 
calculated by the precise dynamics model, and is hereinafter referred to as a true moment about the origin) becomes 0. 
[0098] However in the case where the dynamics mode used in generating a desired gait as described above is not 
a precise model but an approximate model, the true moment about the origin of the generate gait may not be O. More- 
over if the approximate mode is described in a differential equation or an integral equation, which is generally used 

45 for representing the dynamics, the true moment about the origin depends upon a position of the desired ZMP. Thus, 
the true moment about the ongin may move by a very small amount when the position of the desired ZMP is changed 
by a very small amount. Therefore, in this case, if the position of the desired ZMP is moved discontinuously the true 
moment about the origin also changes discontinuously. 

[0099] This means that a true inertial force of the generated gait (an inertial force calculated by the precise model) 
50 becomes discontinuous. This also means that an acceleration (angular acceleration) of displacement of any one or all 
of joints of the robot 1 becomes discontinuous, 

[0100] Therefore, if an approximate error of a model is taken into account, in order to make the generated gait smooth, 
it is desirable to make the desired ZMP trajectory continuous (substantially continuous) even during the floating period. 
However in a dynamics model used in this embodiment, which will be described later since a desired gait, which 
55 reduces a horizontal component of a moment about a desired ZMP to 0, can be unconditionally generated regardless 
of a position of the desired ZMP, it is not always necessary to make the desired ZMP continuous. 
[0101] Note that, in this embodiment, the positions and times of the apexes of the desired ZMP trajectory such as 
shown in Figure 7 are set as ZMP trajectory parameters (parameters defining the desired ZMP trajectory). In addition, 
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the words "substantially continuous" used for representing the ZMP trajectory have the same meaning as in the floor 
reaction force's vertical component trajectory described above. 

[0102] The ZMP trajectory parameters are determined to have a high stability margin and not to change abruptly. 
Here, the high stability margin refers to a state in which the desired ZMP exists near the center of a smallest projecting 
5 polygon (a so-called supporting polygon) Including a contact surface of the robot 1 (for more detail, see Japanese 
Patent Application Laid-Open No. 10-86081). The desired ZMP trajectory In Figure 7 is set so as to satisfy such a 

condition. 

[0103] In addition, the desired arm posture is represented as a relative posture with respect to the body 24. 
[0104] Further the desired body position/posture, the desired foot position/posture and a reference body posture 
10 described later are described In a global coordinate system. The global coordinate system Is a coordinate system that 
is fixed to the floor as described above. More specifically, a supporting leg coordinate system described later is used 

as the global coordinate system. 

[0105] In this embodiment, the gait generation device 100 generates not only the desired body posture but also a 
reference body posture. The reference body posture Is a body posture that is generated complying with a gait request 
15 (request to the gait generation device 1 00 from another device, such as a behavior planning unit, or from the outside 

(via the joystick 44 or the like)). 

[0106] The desired body posture (hereinafter the "body posture" without the word "reference" refers to the desired 
body posture) is generated so as to follow or agree with the reference body posture in the long term. 
[0107] In walking, usually, the desired body posture only has to always agree with the reference body posture as 
20 described in the embodiment described in the specif bation of Japanese Patent Application No. 2000-352011 filed by 
the applicant. In Japanese Patent Application No. 2000-352011 , although the concept of the reference body posture 
is not described, the desired body posture pattern is given explicitly and preferentially, which is equivalent to the desired 
body posture always agreeing with the reference body posture. 

[0108] However, in a gait including a floating period such as running or in walking on a low friction floor surface, the 

25 dynamical equilibrium condition cannot be satisfied simply by adjusting the body's horizontal acceleration while causing 
thefloor reaction force's horizontal component of the desiredgaittofall within the allowable range (or within friction limit). 
[0109] Thus, in this embodiment, the desired body posture is intentionally deviated from the reference body posture 
as required. More specifically, two movement modes, which are described below, are generated in a composite manner 
so as to satisfy the dynamical equilibrium condition while keeping the floor reaction force's horizontal component of 

30 the desired gait within the allowable range (or within friction limit). 

[0110] As shown in Figure 8, if only the body's horizontal acceleration is brought into perturbation (slightly changed) 
from a certain movement state of the robot 1 , the total center-of-gravity horizontal acceleration and the angular mo- 
mentum about the total center of gravity of the robot 1 are brought into perturbation. That is, the perturbation of the 
body's horizontal acceleration causes perturbation of the floor reaction force's moment component about the desired 

35 ZMP (excluding the component about the vertical axis) and the floor reaction force's horizontal component without 
causing perturbation of the floor reaction force's vertical component that is in balance with the resultant force of the 
inertial force and gravity caused by the perturbation of the body's horizontal acceleration in a dynamical sense (without 
causing perturbation of the total center-of-gravity vertical acceleration of the robot 1).The movement mode for causing 
perturbation of the body horizontal acceleration of the robot 1 is referred to as a body translation mode. 

40 [01 1 1 ] In other words, referred to as a body translation mode is such a movement that causes changes of the com- 
ponent of the floor reaction force's moment about the desired ZMP (excluding the component about the vertical axis) 
and the floor reaction force's horizontal component without causing any change of the floor reaction force's vertical 
component. 

[0112] A variation of the floor reaction force moment's component per unit acceleration at this point is denoted by 
45 AMp, and a variation of the floor reaction force's horizontal component per unit acceleration is denoted by AFp. If the 
body 24 is horizontally accelerated in the f onward direction in the situation shown in Figure 8, AMp and AFp are applied 
in the directions indicated by the arrows in Figure 8, respectively. 

[0113] While, in order to be perceptually more readily understood, the body translation mode is represented using 
the floor reaction force balanced with the resultant force of the inertial force and gravity caused by the movement, 

50 representing the same using the resultant force of the inertial force and gravity is more accurate theoretically. Here, 
the resultant force and the floor reaction force have the same magnitude and the opposite directions. 
[0114] On the other hand, as shown in Figure 9, if the body posture angular acceleration (angular acceleration of a 
posture angle of the body 24) is brought into perturbation about a certain point Pr from a certain movement state of 
the robot 1 , the total center of gravity of the robot 1 is not brought into perturbation, but the angular momentum about 

55 the total center of gravity is brought into perturbation. That is, the perturbation of the body posture angular acceleration 
about the point Pr causes perturbation of the component of the floor reaction force's moment (excluding a component 
about the vertical axis) about the desired ZMP, without causing perturbations of the floor reaction force's vertical com- 
ponent and the floor reaction force's horizontal component. The movement mode for causing perturbation of the body 
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posture angle acceleration of the robot 1 in this way is referred to as a body rotation nnode. 

[0115] In other words, referred to as a body rotation models such a nnovement that causes changes of the component 
of the floor reaction force's moment about the desired ZMP (excluding the component about the vertical axis) without 
causing any change of the floor reaction force's vertical component and the floor reaction force's horizontal component. 
5 [0116] A variation of the floor reaction force moment's component per unit angular acceleration Is denoted by AMr 
and a variation of the floor reaction force's horizontal component per unit angular acceleration is denoted by AFr. AFr 
is 0, If an angular acceleration of the body posture angle is generated to cause the body 24 to incline forward in the 
situation shown in Figure 9, AMr is applied in the direction indicated by the arrow in Figure 9, 

[0117] Now, a robot dynamics model used for this embodiment will be described. In this embodiment, a simplified 
10 (approximated) dynamics model shown below is used. However concerning the dynamics model described below, a 
kinematics model (a model roprescnting structures and dimensions of joints and links, that is, a model representing a 
relationship between joint displacement and position/postures of links) is also necessary. 

[0118] Figure 10 is a robot dynamics model used for this embodiment. As shown, this dynamics model has three 
material particles in total, including two material particles 2m, 2m corresponding to the legs 2, 2 of the robot 1 , respec- 
ts tively, and a material particle 24m corresponding to the body 24, and a flywheel FH having a certain inertia and no 
mass . This dynamics model is a decoupled one, that is, the dynamics of the legs 2, 2 (dynamics of the material particles 
2m, 2m) and the dynamics of the body 24 (dynamics of the material particle 24m and the flywheel FH) don't interfere 
with each other, and the dynamics of the whole robot 1 is represented by a linear coupling of these dynamics. In 
addition, the relationship between the movement of the body 24 and the floor reaction force is separated into the 
20 relationship between the translation movement of the body 24 (in the body translation mode) and the floor reaction 
force and the relationship between the rotation movement of the body 24 (in the body rotation mode) and the floor 
reaction force. Specifically, the floor reaction force caused by horizontal movement of the body matehal particle 24m 
corresponds to the floor reaction force caused by hohzontal translation movement of the body 24 (in the body translation 
mode), and the floor reaction force caused by rotation movement of the flywheel corresponds to the floor reaction force 
25 caused by rotation of the posture angle of the body 24 (in the body rotation mode). 

[0119] Here, the mass of the arms of the robot 1 is included in the mass of the body 24, and the body material particle 
24m has a mass including the mass of the arms. In this embodiment, the movement (swing movement) of the arms of 
the robot 1 in the desired gait is attained in such a manner that it cancels the inertial force's moment about the vertical 
axis produced in the robot 1 by the movements other than the swing movement and keeps fixed the relative position 
30 of the center of gravity of the both amns with respect to the body 24. Thus, effects of the swing movement of the arms 
on the floor reaction force moment (except for the component thereof about the vertical axis) and the floor reaction 
force's horizontal component are neglected. 

[0120] In the following, the simplified model will be formulated. In this regard, for the sake of simplicity of explanation, 
only the equation of motion in the sagittal plane (the plane containing the back-and-forih axis (X axis) and the vertical 
35 axis (Z axis)) is described, and the equation of motion in the lateral plane (the plane containing the sideward axis (Y 

axis) and the vertical axis (Z axis)) is omitted. 

[0121] For convenience of explanation, variables and parameters concerning the dynamics model are defined as 
follows. Each of the matehal particles 2m. 2m and 24m is a representative point of its corresponding part or a point 
geometrically uniquely determined from the position/posture of the part. For example, the position of the material particle 
40 2m for the supporting leg 2 is located above the representative point of the sole of the foot 22 of the leg 2 by a prede- 
termined distance. 

Zsup: supporting leg material particle's vertical position 
Zswg: free leg material particle's vertical position 
45 Zb: body material particle's vertical position (typically different from the body's vertical position) 

ZGtotal: total center-of>gravity vertical position 
Xsup: supporting leg material particle's horizontal position 
Xswg: free leg material particle's hohzontal position 

Xb: body material particle's horizontal position (this is a point which is shifted from the point Pr in the back-and- 
50 forth direction by a predetennined distance. The shift is detennined so that the center of gravity in a strict model 

and the center of gravity in this dynamics model agree with each other as precisely as possible when the robot 
stands upright, for example. The body material particle's horizontal position is typically different from the body 
horizontal position.) 

XGtotal: total center-of-gravity horizontal position 
55 e by: body posture angle about the Y axis with respect to the vertical direction (inclination angle) 

mb: body material particle's mass 
msup: supporting leg material particle's mass 
mswg: free leg material particle's mass 
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mtotal: total robot mass (=mtotal+msup+mswg) 

J: body's moment of inertia (This is an equivalent moment of inertia in the body rotation mode.) Typically, this 
doesn't agree with the moment of inertia of the body 24 of the actual robot 1 .) 

Fx: floor reaction force's horizontal component (specifically, the back-and-forth (X axis) component of the transla- 
tion floor reaction force) 

Fz: floor reaction force's vertical component (specifically, the vertical (Z axis) component of the translation floor 
reaction force) In this embodiment, this equals to the desired translation floor reaction force's vertical component) 
My; floor reaction force moment about the desired Zf^P (specifically, the component of the floor reaction force 
moment about the sideward axis (Y axis)) 



[0122] In this embodiment, the relationship between the position of the material particle 2m of each log 2 and the 
position of the foot 22 of the leg 2 (position of a predetermined representative point of the foot 22) is previously pre- 
scribed, and thus, if the position of either one of them is determined, the position of the other is uniquely determined. 
In addition, the relationship between the position of the body material particle 24m and the position of the body 24 
15 (position of a predetermined representative point of the body 24) is previously prescribed in accordance with the posture 
angle of the body 24, and thus, if one of the positions and the posture angle are determined, the position of the other 
is uniquely determined. 

[0123] In addition, for an arbitrary variable X, dX/dtrepresents the first order differential of X, and d2X/dt represents 
the second order differential of X. Thus, if the vanable X represents a displacement, dX/dt represents the velocity, and 
20 d2X/dt represents the acceleration. The character g denotes the coefficient of the acceleration of gravity. Herein, g is 

a positive value. 

[0124] The equations of motion for the dynamics model (fomiulas representing the dynamical equilibrium condition) 
are represented by the formulas 01 , 02 and 03. 



Fz - mb*(g + d2Zb/dt2) + msup*(g + d2Zsup/dt2) 

+ mswg*(g 4 d2Zswg/dt2) formula 01- 

Fx = mb*d2Xb/dt2 + msup*.d2Xsup/dt2 + mswg*d2Xswg/dt2 formula 02 

My= -mb*(Xb-Xzmp)*(g+d2Zb/dt2) + mb* (Zb - Zzmp)*(d2Xb/dt2) 

- msup*(Xsup - Xzmp)*(g + d2Zsup/dt2) 
+ msup*(Zsup - Zzmp)*(d2Xsup/dt2> 

- mswg*(Xswg - Xzmp)*(g + d2Zswg/dt2) 

4- mswg*(Zswg - Zzmp)*(d2Xswg/dt2) + J*d2eby/dt2 formula 03 

[0125] in addition, as for the center of gravity of the whole robot, the following relational formulas hold. 

ZGtotal = (mb*Zb + msup*Zsup + mswg*Zswg)/mtotal formula 04 

XGtotal = (mb*Xb + msup*Xsup + mswg*Xswg)/mtotal formula 05 

[0126] The following are relationships between the dynamics model and AFp, AMp, AFr and AMr. 

[0127] AFp is a perturbation amount of Fx provided when d2Xb/dt2 is brought into perturbation by a unit amount in 

the formula 02 and, thus, can be determined by the following formula. 

AFp = mb formula 06 
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That is, the variation AFp of the horizontal component of the floor reaction force per unit acceleration in the body 
translation mode is equivalent to the mass of the body material particle 24m in the dynamics model. 
[0128] AMp is a perturbation amount of My provided when d2Xb/dt2 is brought into perturbation by a unit amount In 
the formula 03 and. thus, can be determined by the following formula. 

5 

AMp = mb*(Zb - Zzmp) formula 07 

That is. the variation AMp of. the floor reaction force moment's component per unit acceleration in the body translation 
10 mode is the product of the body material particle mass in the dynamics model and the height (vertical position) of the 
body material particle 24m from the desired ZMR The relationship between the positions of the body material particle 
24m and the desired ZMP and the movement of the body materia! particle 24m is equivalent to the behavior of an 
inverted pendulum, the body material particle 24m being assumed to be the material particle of the inverted pendulum 
and the desired ZMP being assumed to be the fulcrum of the inverted pendulum. 
15 [0129] AFr is a perturbation amount of Fx provided when d2eby/dt2 is brought into perturbation by a unit amount in 
the formula 02 and. thus, can be determined by the following fomiula. 



20 



25 



AFr=0 formula 08 

That is, the variation AFr of the horizontal component of the translation floor reaction force per unit acceleration in the 
body rotation mode is 0. 

[0130] AMr is a perturbation amount of My provided when d20by/dt2 is brought Into perturbation by a unit amount in 
the formula 03 and, thus, can be determined by the following formula. 

AMr=J formula 09 



That is, the variation AMr of the floor reaction force moment component per unit acceleration in the body rotation mode 

30 is equivalent to the moment of inertia of the flywheel. 

[0131] The gait generation device 100 according to this embodiment generates sequentially a desired gait for one 
step from the landing of one leg 2 of the robot 1 to the landing of the other leg 2 (the desired gait in the narrow sense) 
with the desired gait for one step as a unit. Therefore, In the running gait shown in Fig. 5 generated in this embodiment, 
the desired gait is generated sequentially from the start of a one-leg supporting period to the end of the following floating 

35 period (that is, the start of the next one-leg supporting period). Here, the desired gait to be newly generated is referred 
to as a "current time gait", the next gait is referred to as a "next time gait", and the desired gait after next is referred to 
as a "next but one gait". In addition, the desired gait generated immediately before the "current time gait" is referred 
to as a "last time gait". 

[0132] When the gait generation device 100 newly generates a current time gait, the required values (requests) of 
40 the expected landing position/posture and expected landing time of the foot 22 of the free leg for the next two steps of 

the robot 1 are input to the gait generation device 1 00 as required gait parameters (or the gait generation device 100 
reads the required parameters from a storage device). Then, using the required parameters, the gait generation device 
100 generates the connected desired body position/posture trajectory, the desired foot position/posture trajectory, the 
desired ZMP trajectory, the desired floor reaction force's vertical component trajectory, the desired arm posture trajec- 
45 tory. and the like. In this case, a part of the gait parameters defining these trajectories are corrected appropriately in 
such amanner that continuity of walking is secured. 

[0133] Now, taking the generation of the running gait shown in Figure 5 as an example, details of a gait generation 
process performed by the gait generation device 100 will be described with reference to Figures 12 to 38. Figure 12 
is a flowchart (structured flowchart) showing a gait generation process performed by the gait generation device 100. 

50 [0134] First, in step S010, various initialization operations, such as an operation of initializing the time tto 0, are 
conducted. This processing is conducted when activating the gait generation device 1 00, for example. Then , the proc- 
ess proceeds to step S014 through step S012, where the gait generation device 100 waits for a timer interruption for 
each control cycle (calculation process cycle of the flowchart in Figure 12). The control cycle is At. 
[0135] Then, the process proceeds to step SOI 6, where it is determined whether a gait transition is detected or not. 

55 If a gait transition is detected, the process proceeds to step SOI 8, or otherwise, the process proceeds to step 8030. 
Here, the "gait transition" means a timing at which generation of the last time gait is completed and generation of the 
current time gait is started. For example, the transition from the control cycle having completed generation of the last 
time gait to the next control cycle is a gait transition. 
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[0136] When the process proceeds to step S018, the time t is initialized to 0. Then, the process proceeds to step 
S020, where a next time gait's supporting leg coordinate system, a next but one time gait's supporting leg coordinate 
system, a current time gait's penod and a next time gait's pehod are read in. These supporting leg coordinate systems 
and gait periods are determined by the required parameters described above. That is, in this embodiment, the required 

5 parameters given to the gait generation device 100 via the joystick 44 or the lil<e include the required values of the 
expected landing posilions/postures of the fool 22 of the free leg (position/posture of the fool 22 which is, once landing, 
rotated without slipping Lo come into conlacl with the floor at substantially the whole surface of the sole) and expected 
landing times for the next two steps. And, the required parameters are given to the gait generation device 100 before 
starting generation of the current time gait (before the gait transition detected in step S016) with the required values 

10 for the first step and the required values for the second step being associated with the current time gait and the next 
time gait, respectively. These required values can be changed in the process of generating the current time gait. 
[0137] The next time gait's supporting leg coordinate system is detemnined depending on the required value of the 
expected landing position/posture of the foot 22 of the free leg for the first step (foot 22 of the free leg in the current 
time gait) Included In the required parameters. 

15 [0138] For example, referring to Figure 15, the required value of the expected landing position/posture of the foot 
22 of the free leg in the current time gait (first step) (foot 22L in the drawing) Is shifted in the X axis direction (back- 
and-forth direction of the foot 22R of the supporting leg in the current gait) and the Y axis direction (sideward direction 
of the foot 22R of the supporting leg in the current gait) in the current time gait supporting leg coordinate system by 
xnext and ynext, respectively, and rotated by Bznext about the Z axis with respect to the landing position/posture of 

20 the foot 22 of the supporting leg in the current time gait (foot 22R in the drawing). Here, the supporting leg coordinate 
system is a global coordinate system (coordinate system fixed to the floor) whose origin is set at a point where a 
perpendicular line, which is drawn from the center of the ankle of the supporting leg 2 to the floor surface in a state 
where the foot 22 of the supporting leg is in a horizontal posture (more generally, parallel to the floor surface) and 
substantially the whole surface of the sole of the foot 22 of the supporting leg is In (intimate) contact with the floor 

25 surface, intersects with the floor surface and whose XY plane is the horizontal plane passing through the origin (In this 
. embodiment, the point agrees with the representative point of the foot 22 in the state where substantially the whole 
surface of the sole of the foot 22 of the supporting leg is in contact with the floor surface). In this case, the X axis and 
Y axis directions are the back-and-forth and sideward directions of the foot 22 of the supporting leg, respectively. Here, 
the origin of the supporting leg coordinate system is not necessarily required to agree with the representative point of 

30 the foot 22 (point representative of the position of the foot 22) in the state where substantially the whole surface of the 
sole of the foot 22 of the supporting leg is In contact with the floor surface, and may be set at a point other than the 
representative point. 

[0139] Here, the next time gait's supporting leg coordinate system is a coordinate system whose origin is set at the 
representative point (or, more specifically, a point matched to the representative point on the floor) of the foot 22L of 

35 the free leg rn the current time gait in the case where the foot 22L lands according to the required value of the expected 
landing position/posture of the foot 22L (where the representative point of the foot 22 agrees with the required value 
of the expected landing position and the posture (orientation) of the foot 22 agrees with the required value of the 
expected landing posture) as shown in the drawing, and whose X' axis and Y' axis directions are the back-and-forth 
and sideward directions of the foot 22L, respectively, in the horizontal plane passing through the origin. 

40 [0140] Similarly, the next but one time gaits supporting leg coordinate system (see the X"Y" coordinate in Figure 1 5) 
is detemnined depending on the required value of the expected landing position/posture of the foot 22 of the free leg 
in the second step. The current time gait's period is a time pehod from the expected landing time (required value) of 
the foot 22 of the supporting leg in the current time gait to the expected landing time (required value) of the foot 22 of 
the free leg in the first step (current time gait) The next time gait's period Is a time period from the expected landing 

45 time (required value) of the foot 22 of the free leg in the first step to the expected landing time (required value) of the 
foot 22 of the free leg in the second step, 

[0141] In this embodiment, the required parameters are Input to the gait generation device 100 by operating the 
joystick 44 as required. Alternatively, the required parameters or the positions/postures and gait periods corresponding 
thereto may be previously stored as a movement schedule of the robot 1 . Alternatively, the next time gait's supporting 
50 leg coordinate, the next but one time gait's supporting leg coordinate, the current time gait's period and the next time 
gait's period may be determined based on an instruction (request) input via a manipulator, such as the joystick 44, and 
the movement history of the robot 1 up to that moment. 

[0142] Then, the process proceeds to step S022, where the gait generation device 1 00 determines gait parameters 
for a normal turning gait, which is a virtual cyclic gait following the current time gait. The gait parameters Include a foot 
55 trajectory parameter for defining a desired foot position/posture trajectory In the normal turning gait, a reference body 
posture trajectory parameter for defining a reference body posture trajectory, and an arm trajectory parameter for 
defining a desired arm posture trajectory, a ZMP trajectory parameter for defining a desired ZMP trajectory and a floor 
reaction force's vertical component trajectory parameter for defining a desired floor reaction force's vertical component 
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trajectory. Furthermore, the gait parameters include a parameter for defining a desired floor reaction force's horizontal 
component allowable range. 

[0143] The term "normal turning gait" in this specification Is used to referto a cyclic gait that, when repeated, results 
in no discontinuity in the movement states (states of the foot position/posture, body position/posture and the tike) of 

5 the robot 1 at the boundaries between the gaits (boundaries between the successive gaits for different steps, in this 
embodiment). In the rollowing, the "normal turning gait " is sometimes abbreviated as a "normal gait". 
[0144] In this embodiment, the normal turning gait is a cyclic gait comprising two steps of the robot 1 , and one cycle 
of the normal turning gait comprises a first turning gaitfollowing the current time gait and a second turning gait following 
the first turning gait. The word "turning" Is used herein because "turning" can include "straight advance" in a broad 

^0 sense since a turning ratio of 0 results in straight advance. Furthermore^ if the desired gait to be generated is the 
running gait shown in Figure 5, the current time gait of the desired gait is a running gait having a one- leg supporting 
period and a floating period. Therefore, both of the first turning gait and second turning gait of the normal turning gait 
are gaits having a one-leg supporting period and a floating period as with the current tihrie gait. That is, the first and 
second turning gaits are basically the same as the current time gait. 

^5 [0145] More specifically, one cycle of the normal turning gait of the two-legged mobile robot requires at least two 
steps of gait in the narrow sense described above, A complicated normal turning gait having a cycle of three or more 
steps of gait can be set. However, as described later, the normal turning gait is used exclusively to determine a diver- 
gence component (described in detail later) at the end (end time) of the current time gait. Therefore, using the normal 
turning gait comprising a cycle of three or more steps is not very effective in spite of the increasing complexity of the 

20 gait generating process. Thus, in this embodiment, one cycle of the normal turning gait is composed of two steps of 
gait (first and second turning gaits). For a legged mobile robot having three or more legs, the number of gaits required 
to define the nomnal turning gait increases accordingly. In the following, for the convenience of explanation, the normal 
turning gait comprising a plurality of gaits in the narrow sense (two steps of gait in this embodiment) is regarded as 
one step of gait. 

25 [0146] The normal turning gait is a provisional gait created in the gait generation device 1 00 for determining move- 
ment states of the robot 1 Including the divergence component at the end of the current time gait, the body's vertical 
positional velocity, the body's posture angle and the angular velocity, and is not output directly from the gait generation 
device 100. 

[0147] Here, the word "divergence" means that the position of the body 24 of the two-legged mobile robot 1 is dis- 

30 placed far from the positions of the feet 22, 22, as shown in Figure 13 The value of the divergence component is a 
numerical value that represents the degree of displacement of the position of the body 24 of the two-legged mobile 
robot 1 from the positions of the feet 22, 22 (more specifically, the origin of the global coordinate system (supporting 
leg coordinate system) set on the surface with which the foot 22 of the supporting leg is In contact). 
[0148] In this embodiment, the desired gait Is generated by using the divergence component as a reference index 

35 in order to allow the gait to be continuous without a divergence occurring in the gait. However, even an initial divergence 
component of a normal gait (a divergence component of a normal gait at the initial time thereof), which is a represent- 
ative example of continuous gaits, is not always simply 0 and varies with a parameter of the normal gait (the normal 
gait is a cyclic gait that has no discontinuity in the trajectory and can be repeated with the same pattern or, in theory, 
can be infinitely repeated without divergence even if repeated infinitely in theory). That Is, the appropriate divergence 

^0 component varies with the gait configuration, for example, the manner of walking or running. Thus, in this embodiment, 
the cun-ent time gait is generated in such a manner that the normal gait to be generated following the current time gait 
is set In accordance with the required parameters of the current time gait, the initial divergence component of the 
normal gait is determined, and then the final divergence component of the current gait is made to agree with the initial 
divergence component of the normal gait (more generally, the current gait is made to be continuous with or close to 

-^5 the normal gait). The basic principle of such gait generation is the same as that described In Japanese Patent Appli- 
cation No. 2000-352011 previously proposed by the applicants. 

[0149] In the embodiments of the present invention, the linear three-material-particle dynamics model used in the 
first embodiment describe in Japanese Patent Application No. 2000-352011 is not used. However, the concept of the 
divergence component and convergence component defined by the following formulas can be applied, in an approxi- 
50 matlon manner with an adequate precision, to a perturbation of the behavior of the nonlinear dynamics model, such 
as the model shown in Figure 10. 



55 



divergence component - body material particle's horizontal 
position f body material particle's horizontal velocity/ioO fomnula 1 0 
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convergence component ^ body material particle's horizontal 

position - body material particle's horizontal velocity/ toO formula 1 1 

5 

[0150] However, the body material particle's horizonlal posillon is the body material particle's horizontal position Xb 
in the dynamics model shown in Figure 10. 

[0151] Furthermore, o>0 is a predetermined value, and the value during running has to be slightly varied from the 
value during walking gait generation described in Japanese Patent Application No. 2000-352011 . 
10 [0152] Other details concerning the divergence and convergence components are described in Japanese Patent 
Application No. 2000-352011, and thus, further deschption thereof is omitted herein. 

[0153] In this embodiment, in addition to the method described in Japanese patent application no. 2000-362011 , as 
described later a gait parameter that defines the desired floor reaction force's vertical component trajectory is set, and 
the total center-of -gravity vertical position of the robot 1 is determined so as to satisfy, in terms of dynamics, the desired 

15 floor reaction force's vertical component. In this case, the second-order integral of the floor reaction force's vertical 
component defines the total center-of-gravity vertical position of the robot 1 . Therefore, if the desired floor reaction 
force's vertical component is set inadequately, the total center- of-gravity vertical position or body's vertical position of 
the robot 1 becomes too high or too low. Therefore, how to set the desired floor reaction force's vertical component is 
also an important problem. However, a relationship between a floor reaction force's vertical component and a body 

20 vertical position is similar to a relationship between a ZMP and abody horizontal position. Thus, only by slightly changing 
a part of desired ZMP determination method for making a body horizontal position/velocity appropnate as indicated in 
this embodiment described below, the desired ZMP determination method can be applied to a determination method 
for a desired floor reaction force's vertical component for making a body vertical position/velocity appropriate. 
[0154] Returning to the main subject, in step S022, a process described below is conducted In accordance with the 

25 flowchart shown in Figure 14. 

[0155] First, in step SI 00, foot trajectory parameters of the gait parameters for the nomnal gait are determined in 
such a manner that the foot position/posture trajectories of the current time gait, the first turning gait and the second 
turning gait are connected to each other in this order. A specif ic setting manner will be described below with reference 
to Figure 15. In the following description, the foot 22 of the supporting leg 2 is referred to as a supporting leg's foot, 

30 and the foot 2 of the free leg 2 is referred to as a free leg's foot. Furthermore, the temns "initial (start)" and "final (end)" 
concerning the "gait" mean the start time and end time of the gait, respectively, or instantaneous gaits at the start time 
and end time of the gait, respectively. 

[0156] The foot trajectory parameters include supporting leg's foot positions/postures and free leg's foot positions/ 

postures at the start and end of the first turning gait and the second turning gait, and gait periods of the turning gaits. 

35 Of the foot trajectory parameters, the free leg's foot position/posture at the start of the first turning gait is regarded as 
the supporting leg's foot position/posture at the end of the current time gait seen from the next time's gait supporting 
leg coordinate system. In this case, in the running gait, the supporting leg's foot 22 at the end of the current time gait 
has floated in the air The supporting leg's foot position/posture at the end of the current time is determined by using 
the finite duration settling filter to generate, until the end of the current gait, the foot position/posture trajectory (spe- 

40 cifically, trajectory seen from the next time gait's supporting leg coordinate system) that leads from the supporting leg's 
foot position/posture at the start of the current time gait (- the free leg's foot position/posture at the end of the last time 
gait) to the free leg's foot position/posture at the end of the next time gait that is detemnined depending on the required 
value of the expected landing position/posture of the free leg's foot 22 for the second step (required value of the 
expected landing position/posture in the next time gait of the supporting leg's foot 22 in the current time gait) of the 

45 required parameters or the next but one time gait's supporting leg coordinate system associated with the required value. 
[0157] Here, the free leg's foot position/posture at the end of the next time gait is detennined in such a manner that 
the position/posture of the foot 22 rotated from the position/posture by a predetermined angle to the horizontal posture 
in the pitch direction by lowering the toe while keeping the foot 22 In contact with the floor agrees with the position/ 
posture thereof in the next but one time gait's supporting leg coordinate system. In other words, the free leg's foot 

50 position/posture at the end of the next time gait is the position/posture of the foot 22 that is rotated by a predetermined 
angle In the pitch direction by raising the toe while keeping the foot 22 in contact with the floor without slipping (a state 
where the foot 22 has the toe raised and the heel in contact with the floor) from the required value of the landing 
position/posture of the free leg's foot 22 in the second step of the required parameters. 

[0158] In addition, the supporting leg's foot position/posture at the start of the first turning gait is regarded as the free 
55 leg's foot position/posture at the end of the current time gait seen from the next time gait's supporting leg coordinate 
system. In this case, as with the free leg's foot position/posture at the end of the next time gait, the free leg's foot 
position/posture at the end of the current time gait is determined depending on the next time gait's supporting leg 
coordinate system or the required value of the expected landing position/posture of the free leg for the first step (current 
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time gait) of the required parameters associated with the next time gait's supporting leg coordinate system. That is, 
the free leg's foot position/posture at the end of the current time gait is detemnined in such a manner that the repre- 
sentative point of the toot 22 rotated from the position/posture by lowehng the toe while l<eeping the foot 22 in contact 
with the floor to bhng substantially the whole of the sole of the foot 22 into contact with the floor agrees with the origin 

5 of the next gait's supporting leg coordinate system. 

[0159] As with the free leg's foot position/posture al the end of the current time gait and the free leg's foot position/ 
posLure at the end of the next time gait, the free leg's position/posture al the end of the first turning gait is determined 
based on the position/posture in the next but one time gait's supporting leg coordinate system seen from the next time 
gait's supporting leg coordinate system. More specifically, the free leg's foot position/posture at the end of the first 

10 turning gait is set In such a manner that the position/posture of the foot 22 that is rotated from the position/posture by 
a predetermined angle to the horizontal posture while keeping the foot 22 in contact with the floor without slipping 
agrees with the position/posture in the next but one time gait's supporting leg coordinate systerh seen from the next 
time gait's supporting leg coordinate system. 

[0160] At the end of the first turning gait, the supporting leg's foot 22 is away from the floor and floats In the air To 

15 determine the trajectory after the supporting leg's foot 22 takes off the floor, an expected landing position/posture of 
the first turning gait's supporting leg's foot is set. The expected landing position/posture of the first turning gait's sup- 
porting leg's foot is set based on the position/posture in a next but two gait's supporting leg coordinate system seen 
from the next time gait's supporting leg coordinate system. More specifically, the expected landing position/posture of 
the first turning gait's supporting leg's foot is the position/posture in the next but two gait's supporting leg coordinate 

20 system seen from the next time gait's supporting leg coordinate system. Here, the next but two gait's supporting leg 
coordinate system is set in such a manner that the relative position/posture relationship between the next but one time 
gait's supporting leg coordinate system and the next but two gait's supporting leg coordinate system agrees with the 
relative position/posture relationship between the current time gait's supporting leg coordinate system and the next 
time gait's supporting leg coordinate system. 

25 [0161] As with the supporting leg's foot position/posture at the start of the first turning gait, the supporting leg's foot 
position/posture at the end of the first turning gait is determined by using the finite duration settling filter to generate 
the foot position/posture trajectory leading from the supporting leg's foot position/posture at the start of the first turning 
gait to the expected landing position/posture of the first turning gait's supporting leg's foot (more specifically, trajectory 
seen from the next time gait's supporting leg coordinate system) until the end of the first turning gait. 

30 [0162] The free leg's foot position/posture at the start of the second turning gait is the supporting leg's foot position/ 
posture at the end of the first turning gait seen from the next but one time gait's supporting leg coordinate system. The 
supporting leg's foot position/posture at the start of the second turning gait is the free leg's foot position/posture at the 
end of the first turning gait seen from the next but one time gait's supporting leg coordinate system. 
[0163] The free leg's foot position/posture at the end of the second turning gait Is the free leg's foot position/posture 

35 at the end of the current time gait seen from the current lime gall's supporting leg coordinate system. The supporting 
leg's foot position/posture at the end of the second turning gait is the supporting leg's foot position/posture at the end 
of the current time gait seen from the current time gait's supporting leg coordinate system. 

[0164] The gait periods of the first and second turning gaits are set to be the same as the period of the next time 
gait. The gait periods of the first and second turning gaits are not necessarily required to be the same. However, both 

40 the periods are preferably determined in accordance with the period of the next time gait. Movement parameters of 
the current time gait, the first turning gait and the second turning gait other than those described above (Including time 
parameters including the two leg supporting period duration) are appropriately determined so as to satisfy the gait 
requirements (for example, that the velocity of an actuator falls within an allowable range, that an allowable angle of 
the actuator is not surpassed and that a foot is not in contact with the floor or the like) in accordance with the parameters 

45 determined as described above. 

[0165] Then, the process proceeds to step S102, where the reference body position/posture trajectory parameter 
for defining the reference body position/posture trajectory to be followed by the desired body posture is determined. 
The reference body posture is not necessarily required to be constant, as far as the reference body posture is the same 
at the start of the normal gait (start of the first turning gait) and the end thereof (end of the second turning gait) (the 

50 posture angle of the reference body posture and the angular velocity thereof are the same at the start and the end of 
the normal gait). However, in this embodiment, to be readily understood, the reference body posture is the upright 
posture (vertical posture). That is, in this embodiment, the reference body posture is the upright posture throughout 
the duration of the normal gait. Therefore, in this embodiment, the angular velocity and angular acceleration of the 
posture angle of the reference body posture are 0. 

55 [0166] Then, the process proceeds to step S104, where anm posture trajectory parameters, more specifically, the 
arm posture trajectory parameters other than those concerning the angular momentums of the arms about the vertical 
axis (or body trunk axis) are determined. For example, ann posture trajectory parameters, such as the relative height 
of the tip of the arm with respect to the body 24 or the relative position of the center of gravity of the entire arm with 
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respect to the body 24, are determined. In this embodinrient, the relative position of the center of gravity of the entire 
arm is kept constant with respect to the body. 

[0167] Then, the process proceeds to step S106, where floor reaction force's vertical component trajectory param- 
eters are set. In this case, the floor reaction force's vertical component trajectory parameters are set in such a manner 

5 that the floor reaction force's vertical component trajectory defined by the parameters is substantially continuous (I.e., 
has no step-wise discrete values) in the first and second turning gaits as shown in Figure 6. That is, the desired floor 
reaction force's vertical component trajectory of the normal turning gait is set to be the pattern shown in Figure 16. 
According to this pattern, both for the first and second turning gaits, the floor reaction force's vertical component varies 
in a trapezoidal shape during the one leg supporting period and is kept at 0 during the floating period. And, the times 

10 of the apexes of the pattern and the heights (peak values) of the trapezoids are set as the floor reaction force's vertical 
component trajectory parameters. 

[0168] In setting the floor reaction force's vertical component trajectory parameters, the average value of the floor 
reaction force's vertical component for the whole gait duration (period of one cycle of the normal gait, which is a sum 
of the periods of the first and second turning gaits) is made to agree with the weight of the robot 1 . That is, the average 
15 value of the floor reaction force's vertical component is made equal In magnitude and opposite In direction to gravity 

applied to the robot 1 . 

[0169] Setting the floor reaction force's vertical component trajectory as described above is required to satisfy the 
normal gait requirement. The normal gait requirement is that the initial states of all the state vahables (positions, pos- 
tures and velocities of the parts of the robot 1 ) of the gait seen from the supporting leg coordinate system (coordinate 

20 system set on the surface at which the supporting leg's foot 22 is in contact) agree with the final states of the gait (final 
states of the second turning gait) seen from the next supporting leg coordinate system (supporting leg coordinate 
system of the next first turning gait) (hereinafter, this requirement is sometimes referred to as a boundary requirement 
of the normal gait). Therefore, the difference between the total center-of-gravity vertical velocity of the robot 1 at the 
end of the normal gait and the total center-of-gravity vertical velocity at the start of the nomial gait (more specifically, 

25 difference between the total center-of-gravity vertical velocity at the end of the second turning gait and the total center- 
of-gravity vertical velocity at the start of the first turning gait) has to be 0. Since the difference described above is an 
integral (first order integral) of the difference between the floor reaction force's vertical component and gravity, the floor 
reaction force's vertical component trajectory has to be set as described above in order for the difference to be 0. 
[0170] In this embodiment, the average values of the floor reaction force's vertical component for the periods of the 

30 first and second turning gaits are made to agree with the weight of the robot 1 . More specifically, for example, after the 
times of the apexes of the trapezoidal line of the floor reaction force's vertical component trajectory in the first and 
second turning gaits are determined in accordance with the periods of the gaits, the heights of the trapezoids are 
determined in such a manner that the average values of the floor reaction force's vertical component for the first and 
second turning gaits agree with the weight of the robot 1 (the height of the trapezoids is determined by solving an 

35 equation representing agreement between the average values and the weight with the height of the trapezoid being 
assumed to be an unknown quantity). 

[0171] This results in a difference of 0 between the total center-of-gravity vertical velocity at the end of the first turning 
gait and the total center-of-gravity vertical velocity at the start of the first turning gait and a difference of 0 between the 
total center-of-gravity vertical component at the end of the second turning gait and the total center- of-gravityvertical 
40 velocity at the start of the second turning gait. However, this is not essential. Alternatively, for example, the body's 
vertical position becomes too high or too low and, thus, the robot takes an unreasonable posture in the vicinity of the 
boundary between the first and second turning gaits, the height of the trapezoid of the floor reaction force's vertical 
component trajectory for the turning gaits may be modified from the state where the average values for the turning 
gaits agree with the weight. 

45 [0172] Then, the process proceeds to step 8108, where an allowable range [Fxmin, Fxmax] (more specifically, a 
parameter that defines the allowable range) of the floor reaction force's horizontal component is determined, as shown 
in Figure 1 7, in accordance with the floor reaction force's vertical component trajectory determined as described above 
as shown in Figure 1 6. The polygonal line on the negative side in Figure 17 represents the floor reaction force's hori- 
zontal component's allowable lower limit value Fxmin, and the polygonal line on the positive side represents the floor 

50 reaction force's horizontal component's allowable upper limit value Fxmax, Thefollowing is a supplementary description 
of a method of setting these values. In the following, a case where the floor surface is horizontal will be described. 
[0173] The floor reaction force's horizontal component occurs due to friction between the floor and the foot 22. How- 
ever, friction cannot be produced infinitely. Therefore, in order to prevent the actual robot 1 from slipping when it moves 
in accordance with the desired gait generated, the floor reaction force's horizontal component of the desired gait has 

55 to always fall within the friction limit. Thus, in order to satisfy this requirement, the floor reaction force's horizontal 
component allowable range is set, and, as described later, the desired gait is generated in such a manner that the floor 
reaction force's horizontal component of the desired gait falls within the allowable range. 

[0174] Assuming that the friction coefficient between the floor and the foot 22 is \i, the value of Fxmin has to be 
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always equal to or higher than - fx * (floor reaction force's vertical component), and the value of Fxmax has to be always 
equal to or lower than |i * (floor reaction force's vertical component). The simplest settings are as follows. Herein, ka 
is a positive constant smaller than 1 . 

5 

Fxmin = -ka * u * (floor reaction force's vertical component) 

Fxmax = ka * (j. * (floor reaction force's vertical component) formula 12 

10 [0175] The floor reaction force's horizontal component allowable range shown in Figure 17 is an exemplary range 
set in accordance with the formula 12. As parameters for defining the floor reaction force's horizontal component 
allowable range the times of the apexes of trapezoidal waveform and the values of the waveform at the times in Figure 
17 may be set. However, in the case where the floor reaction force's honzontal component allowable range is deter- 
mined by the formula 12, the parameter to be set may be only the value of (ka * p.) in the formula 12. 

15 [0176] As far as the requirement (that the floor reaction force's horizontal component of the desired gait always falls 
within the friction limit) is satisfied, the floor reaction force's horizontal component allowable range may be set in any 
other setting method. 

[0177] Then, the process proceeds to step S110, where a ZMP trajectory parameter that define the ZMP trajectory 
for the normal gait, which is a sum of the first and second turning gaits, is determined. In this case, the desired ZMP 

20 trajectory Is determined to have a high stability margin. and not to change abruptly, as described above. 

[0178] More specifically, in the running gait shown in Figure 5, the heel of the supporting leg's foot 22 first lands, and 
some time after that, substantially the whole surface of the sole of the supporting leg's foot 22 comes into contact with 
the floor. Then, only the toe of the supporting leg's foot 22 comes into contact with the floor. Then, the robot jumps into 
the air by kicking the floor on the toe of the supporting leg's foot 22, and finally, the heel of the free leg's foot 22 lands. 

25 Besides, the desired ZMP has to lie within the contact surface. Thus, in this embodiment, as shown In the upper part 
of Figure 7, both for the first and second turning gaits of the normal gait, the x-axis directional position of the desired 
ZMP is set to remain at the initial position, which is the position of the heel of the supporting leg's foot 22, until sub- 
stantially the whole surface of the sole of the foot 22 comes into contact with the floor. Then, the desired ZMP is shifted 
to the middle of the supporting leg's foot 22 and then to the toe, making the foot 22 in contact with the floor only at the 

30 toe. Then, the desired ZMP remains at the position of the toe of the supporting leg's foot 22 until the foot takes off the 
floor. After that, as described above, the desired ZMP Is shifted continuously from the toe of the supporting leg's foot 
22 to the landing position of the heel of the free leg's foot 22 by the time of the next landing of the free leg's foot 22. 
Thus, the desired ZMP trajectory (X-axis directional trajectory) for the normal gait comprising the first and second 
turning gaits is as shown in Figure 18. The times and positions of the apexes of the desired ZMP trajectory are set as 

35 ZMP trajectory parameters. In this case, the times of the apexes of the trajectory are determined based on the gait 
periods of the first and second turning gaits determined based on the required parameters, and the positions of the 
apexes of the trajectory are determined based on the positions/postures in the next time gait's supporting leg coordinate 
system and the next but one time gait's supporting leg coordinate system, or based on the required values of the 
expected landing positions/postures of the free leg's foot for the first and second steps of the required parameters that 

40 define these coordinate systenris. The Y-axis directional position of the ZMP trajectory is determined as shown in the 
lower part of Figure 7. More specifically, the trajectory of the Y-axis directional position of the desired ZMP for the first 
turning gait is set in the same pattern as that shown in the lower part of Figure 7, and the trajectory of the Y-axis 
directional position of the desired ZMP for the second turning gait is set to have the same shape as that for the first 
turning gait and to be connected to the end of the trajectory for the first turning gait. 

45 [0179] Finally, the process proceeds to step S112, where the initial time, the end time and the period of one step 
(one cycle) of the normal gait are redefined as follows. 

[0180] The nonnal gait has to be a gait having state variables that are continuous at the start and the end thereof. 
For convenience of determination of such a gait, in this embodiment, until the nonnal gait is detennined, unlike the 
definition of the gait in the narrow sense, the initial time, the end time and the period of one step of the normal gait are 

50 defined as shown in Figure 1 6. That Is, the time at which the floor reaction force's vertical component is decreased to 
some degree in the latter half of the one leg supporting period of the first turning gait is set as the initial time Ts of the 
normal gait. As shown in Figure 7, the initial time Ts is preferably set to the instant when the supporting leg's foot 22 
having been in contact with the floor at substantially the whole surface of the sole thereof comes into contact with the 
floor only at the toe thereof or a time immediately before the instant (the end time of the period in which whole the sole 

55 of the foot is in contact with the floor or a time immediately before the end time in Figure 7). In addition, as for the 
relationship between the desired ZMP and the time Ts determined in step S110 and shown in Figure 18 (or Figure 7), 
it is preferable that the time Ts Is the instant when the supporting leg's foot is In contact with the floor only at the toe 
after the desired ZMP has been completely shifted to the toe of the supporting leg's foot 22 through the middle thereof 
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after substantially the whole surface of the sole of the supporting leg's foot 22 had come into contact with the floor in 
the first turning gait. Such an initial time Ts is determined in accordance with the desired ZMP trajectory parameter 
previously determined, for example. The reason why the initial timeTs is detennlned as described above will be de- 
scribed later. 

5 [0181] Furthermore, as shown In Figure 16, the period Tcyc of the nomnal gait Is a sum of the gait periods of the first 
and second turning gails. The end time of the normal gail is Te. Te is the time Ts plus Tcyc. 

[0182] From Ihe point in lime when Ihe normal gait is determined (when the loop of step S204 in Figure 19 described 
later exits), the definitions of the initial time, the end time and the like of the gait in the narrow sense described above 
are adopted again. In the following description, the initial time according to the definition of the gait in the narrow sense 
10 described above (the time of the landing of the supporting leg's foot 22) is assumed to be 0, and reference symbol Ts 
is used to dischminate this original initial time 0 from the above-described initial time Ts used until the normal gait is 
determined (sometimes simply abbreviated as "Ts"). 

[0183] After the processings from steps SOI 0 to 8022 in Figure 12 is conducted, the process proceeds to step S204, 
where initial states of the normal gait are calculated. The initial states calculated in this step include the initial body 
15 horizontal position/velocity (initial body position and initial body velocity in the horizontal direction), the initial body 

vertical position/velocity (initial body vertical position and initial body velocity in the vertical direction), the initial diver- 
gence component, the initial body posture angle and the angular velocity thereof for the normal gait. These initial states 
are calculated in a searching manner according to the flowchart in Figure 1 9. 

[0184] In the flowchart in Figure 19, first, in step S200, the initial states (states at the initial time Ts) of the desired 

20 foot position/posture, the desired arm posture and the desired body posture angle (posture angle and direction) are 
determined based on the gait parameters for the normal gait (parameters determined in step S022 in Figure 12). The 
term "state" refers to a position ^ a posture angle and variation rates (time differentials) thereof. 
[0185] In this case, the initial state of the desired foot position/posture of the supporting leg is determined by using 
the finite duration settling filter to generate the foot position/posture trajectory (trajectory seen from the next time gait's 

25 supporting leg coordinate system) leading from the supporting leg's foot position/posture at the start of the first turning 
gait of the foot trajectory parameters determined in step S100 in Figure 14 to the free leg's foot position/posture at the 
end of the second turning gait until the time Ts. The initial state of the desired foot position/posture for the free leg is 
determined by using the finite duration settling filter to generate the foot position/posture trajectory leading from the 
supporting leg's foot position/posture at the start of the current time gait seen from the next time gait's supporting leg 

30 coordinate system to the free leg's foot position/posture at the end of the first turning gait until the time Ts. Besides, 
the initial state of the desired arm posture is detemiined by determining the arm posture (total center-of-gravity position 
of the arms with respect to the body 24, for example) at the time Ts based on the arm posture trajectory parameters 
determined in step SI 04 in Figure 14. Besides, as the initial state of the desired body posture angle, the reference 
body posture (posture angle) and the angular velocity thereof at the time Ts, which are deternrilned based on the 

35 reference body posture trajectory parameters determined in step S102 in Figure 14, are determined. In this embodi- 
ment, since the reference state posture angle is the vertical posture, the initial state of the desired body posture angle 
is 0 (the posture angle and the angular velocity thereof are 0). Furthermore, in this embodiment, the desired foot 
position/posture trajectory, the floor reaction force's vertical component trajectory and the desired ZMP trajectory for 
the normal gait are independently determined from the foot trajectory parameters, the floor reaction force's vertical 

40 component trajectory parameters and the ZMP trajectory parameters determined in the flowchart in Figure 1 4, respec- 
tively. For example, the instantaneous desired foot position/posture for the normal gait is determined based on the foot 
trajectory parameters, independently of the instantaneous value of the floor reaction force's vertical component. 
[0186] Then, in step S202, (Xs, Vxs), which are candidates for the Initial body horizontal position/velocity (that is, 
body horizontal position/posture candidates at the initial time Ts), are provisionally determined, where Xs Is the hori- 

45 zontal position and Vxs is the horizontal velocity. The candidates (Xs, Vxs) provisionally determined in this step may 
be arbitrary ones and, for example, may be the body horizontal position/velocity of the initial states of the nomrial gait 
determined when the last time gait is generated. 

[0187] Forthesimplicityof explanation, a case where the Initial states for the normal gait in the X direction (back and 
forth direction) in the sagittal plane are searched for is taken as an example. Actually, however, both for the position 
50 and velocity, the Initial states for the normal gait (initial states that satisfy the boundary requirement of the normal gait) 
for the X direction (back and forth direction) and the Y direction (sideward direction) have to be searched for separately 

or concurrently. 

[0188] As the determination method in a searching manner, the simplex method or a method of determining an affine 
Jacobian (sensitivity matrix) and determining a next candidate by the steepest descent method may be used. In this 
55 embodiment, the steepest descent method is used. 

[0189] Then, in step S206 after step 8204, the initial (time Ts) body vertical position/velocity (Zs, Vzs) is determined, 
where Zs is the vertical position and Vzs is the vertical velocity 

[0190] In this embodiment, the initial body vertical velocity Vzs is detemnined as follows In an analytical manner 
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[0191] For the robot 1 , the following dynamical relationship holds. 

(final total center-of-gravity vertical position) - (initial 
^ total center-of-gravity vertical position) 

= second order integral of (floor reaction force's vertical 

component/total mass of the robot) 
+ second order integral of the gravitational acceleration 
+- (initial total center-of-gravity vertical velocity) * 

15 

(duration of one step) formula 1 3 

(The gravitational acceleration is a negative value,) 

[0192] In the normal gait, since the final total center-ot-gravity vertical position agrees with the initial total center-of- 
20 gravity vertical position, the right side in the formula 13 has to be 0. Thus, the initial total center-of-gravity vertical 
velocity can be determined from these relationships. Specifically, a value obtained by dividing the floor reaction force's 
vertical component, which is calculated from the floor reaction force's vertical component parameters set in step S104 
in Figure 14, by the total mass of the robot 1 is integrated two times with respect to the period of one step (from the 
time Ts to the time Te), thereby determining the displacement of the total center of gravity due to the floor reaction 
25 force's vertical component (first term in the right side of the fomnula 13). Furthermore, the gravitational acceleration is 
integrated two times with respect to the period of one step, thereby determining the displacement of the total center 
of gravity due to gravity (second term In the right side of the formula 13). Then, the sum of the displacement of the 
total center of gravity due to the floor reaction force and the displacement of the total center of gravity due to gravity 
is inverted in sign, and the resulting value is divided by the duration of one step (duration of one cycle Tcycl of the 
30 normal gait), thereby determining the initial total center-of-gravity vertical velocity. 

[0193] Then, in order to determine the initial body vertical position Zs, the total center-of-gravity vertical velocity at 
the time 0 is determined using the following fomnula. In this process, the value determined from the formula 13 as 
described above is substituted for the total center-of-gravily vertical velocity at the time Ts in the following formula, and 
the integral time is from the time 0 to the time Ts. 

35 

(total center-of-gravity vertical velocity at the time Ts) 
- (total center-of-gravity vertical velocity at the time 0) 

40 

= first order integral of (floor reaction force's vertical 

component/total mass of the robot) 
+ first order integral of the gravitational acceleration formula 1 4 

(The gravitational acceleration is a negative value.) 

[0194] Then, the body height determination method proposed in Japanese Patent Laid-Open No. 10-86080 by the 
applicants is used to determine the body height (body vertical position) at the time 0 (that is, at the Instant of landing). 

50 In this process, the body vertical position (body height) that allows the knees of the legs 2, 2 not to be fully stretched 
at the time 0 is determined based on the foot position/posture at the time 0 (the supporting leg's foot position/posture 
at the start of the first turning gait (at the time 0) and the free leg's foot position/posture at the start of the first turning 
gait (at the time 0) determined in step S100 in Figure 14) and a predetermined geometrical condition concerning the 
bending angle of the knees of the legs 2. Specifically, assuming that the bending angle of the knee of the supporting 

55 leg 2 is Gsup and the bending angle the knee of the free leg 2 is Bswg, the body vertical position is detemnined in such 
a manner that the sum of the inverse numbers of the sinusoidal values of the knee bending angles Bsup and Oswg 
equals to a predetermined value (finite value), for example. Here, the knee bending angles 6sup and Bswg are the 
angles of the center axis of the crus part with respect to the center axis of the thigh part of each leg 2 and increase 
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from 0 as the knee is bent from a state where each leg 2 is fully stretched. Such a method of determining the vertical 
position of the body 24 is described in detail In Japanese Patent Laid-Open No. 1 0-86080, and thus, further deschption 
thereof is omitted herein. 

[0195] Then, from the body vertical position and the foot position/posture at the time 0 thus detemnined, the total 
5 center-of-gravlty vertical position at the time 0 is determined using the robot 1 model. For example, the i<inematics 
model represented by the formula 04, which corresponds to the model shown in Figure 10, may be used to determine 
the total cenler-of-gravily vertical position at the time 0. Specifically, the vertical position of the body material particle 
24m is determined from the body vertical position and the body posture angle (0 in this embodiment) at the time 0, and 
the vertical positions of the supporting leg material particle 2m and the free leg material particle 2m are determined 
10 from the supporting leg's foot position/posture and the free leg's foot position/posture at the time 0 (the supporting leg's 
foot position/posture at the start of the first turning gait and the free leg's foot position/posture at the start of the first 
turning gait determined in step 8100 in Figure 14), respectively. Then, these vortical positions of the body material 
particle 24m, the supporting leg material particle 2m and the free leg material particle 2m are substituted forZb, Zsup 
and Zswg in the formula 04, respectively, thereby determining the total center-of -gravity vertical position (ZGtotal in 
15 the formula 04). Alternatively, a more precise model of the robot 1 (for example, the multi-mass model such as shown 
in Figure 1 1 ) may be used to take into consideration the body horizontal position and the arm posture at the time 0 to 
determine the total center- of- gravity vertical position at the time 0. 

[0196] Then, in the formuia 13, the total center-of-gravity vertical position at the time 0 determined as described 
above is substituted for the initial total center-of-gravity vertical position in the left side of the formula 13, the total 

20 center-of-gravity vertical velocity at the time 0 determined as described above is substituted for the initial total center- 
of-gravity vertical velocity in the right side of the formula 13, Ts is substituted for the duration of one step in the formula 
13, and a period from the time 0 to the time Ts is defined as the integral time, thereby calculating the value of the final 
total center-of-gravity vertical position in the left side of the formula 13, which is regarded as the initial (time Ts) total 
center-of-gravity vertical position. Furthemr»ore, from the initial (time Ts) total center-of-gravity vertical position , the foot 

25 position/posture at the time Ts (determined In step S.200) and the like, the initial (time Ts) body vertical position Zs is 
determined using a model of the robot 1 (the kinematics model represented by the formula 04, for example). Specifically, 
from the horizontal positions/postures of the supporting leg and the free leg at the time Ts, the vertical positions of the 
supporting leg material particle 2m and the free leg material particle 2m in the model shown in Figure 10 are determined, 
and the vertical positions and the initial (time Ts) total center-of-gravity position determined as described above are 

30 applied to the fomiula 04, thereby determining the vertical position of the body material particle 24m (Zb in the formula 
04). Then, from the vertical position of the body material particle 24m and the body posture at the time Ts (0 in this 
embodiment), the initial (time Ts) body vertical position Zs can be determined in an inverse operation manner. In this 
case also, a more precise model may be used to take into consideration the body horizontal position and the arm 
posture to detennine the initial body vertical position Zs. 

35 [0197] Finally, from the initial stale of the foot position/posture determined in step S200, the initial total center-of- 
gravity vertical velocity determined in step S206 and the like, the initial body vertical velocity is determined using a 
model of the robot 1 (for example, the kinematics model represented by the formula 04). Specifically, the initial total 
center-of-gravity vertical velocity determined based on the formula 13 and the vertical velocities of the supporting leg 
material particle 2m and the free leg material particle 2m determined by the initial states of the foot positions/postures 

40 of the supporting leg and free leg are applied to a formula obtained by time-differentiating the both sides of the formula 
04, thereby determining the vertical velocity of the body material particle 22m. Then, from the vertical velocity of the 
body material particle 22m and the initial state of the body posture angle (determined in step S200 or S208 described 
later), the body vertical velocity is determined. Alternatively, such an initial body vertical velocity that provides the initial 
total center-of-gravity vertical velocity determined as described above may be determined using a more precise model 

45 of the robot 1 by taking into consideration the initial state of the arm posture (determined in step S200), the initial state 
of the body horizontal position provisionally detennined (the latest ones provisionally determined in step S202 or step 
S216 or S218 descnbed later) and the initial body vertical position determined as described above in addition to the 
initial state of the foot position/posture and the initial total center-of-gravity vertical velocity. 

[0198] More specifically, even if the model of the robot 1 is a complicated (precise) one such as shown in Figure 11 , 
50 since the robot 1 has six degrees of freedom for each leg, all the initial states of the robot are determined uniquely if 
the initial states of the foot position/posture trajector/ and the body position/posture trajectory (position/posture and 
the vanation rates thereof) are given. Therefore, the initial total center-of-gravity vertical velocity can be determined 
uniquely if the same are given. Inversely, since the robot has six degrees of freedom for each leg, even if one, concerning 
velocity, of the initial states of the foot position/posture trajectory and the body position/posture trajectory (for example, 
55 the initial body vertteal velocity) is undetermined, the undetermined initial state Is determined uniquely if the initial total 
center-of-gravity vertical velocity is given. 

[0199] After the processing of step S206, the process proceeds to step S208, where a provisional normal turning 
gait is generated. More specifically, based on the gait parameters of the normal gait determined In step 8022 in Figure 
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12, the desired ZMR the desired floor reaction force's vertical component, the desired foot position/posture, the refer- 
ence body posture, the desired arm posture and the floor reaction force's horizontal component allowable range at 
instants between the initial timeTs and the end time Te are detemnined successively. Then, in such a manner that the 
dynamical equilibrium conditions concerning the desired ZMP and the desired floor reaction force's vertical component 

5 and the condition concerning the floor reaction force's horizontal component allowable range are satisfied, the body 
position/posture is determined using the dynamics model (model shown in Figure 1 0) assuming that the body hohzonlal 
posilton/velocily (Xs. Vxs) and Ihe body vertical position/velocity (2s, Vzs) are the initial (lime Is) stales of the body 
24, thereby generating the gait from the time Ts to the end time Te. In this process, the body posture is generated so 
as to agree with the reference body posture as closely as possible. 

10 [0200] The generation of the normal gait is performed only in the gait generation device 100= and the result is not 
output to the composite-compliance dotcrminator 1 04, described later, as a desired value for driving the actual robot 1 
[0201] Details of a normal gait generation process using successive calculation, which is the processing in step 
S208, will be described below. 

[0202] Figure 20 is a subroutine flowchart showing the process. 

15 [0203] In step S300, various initializations are performed. Specifically, the initial time Ts is substituted for the provi- 
sional gait generation time k. Furthermore, the currently determined provisional values (Xs, Vxs) (determined in step 
S202 in Figure 19 or steps S216 or S218 described later) are substituted for the body horizontal position/velocity, and 
the latest values (Zs, Vzs) determined in step S206 are substituted for the body vertical position/velocity. In addition, 
the reference body posture angle's initial value (reference body posture angle at the time Ts) is substituted for the 

20 desired body posture angle, and the reference body posture angular velocity's initial value (reference body posture 
angular velocity at the timeTs) is substituted for the desired body posture angular velocity. In addition, the initial desired 
body posture angular velocity is eventually changed as described later, and therefore, a value different from the refer- 
ence body posture angular velocity's initial value may be substituted for the desired body posture angular velocity. 
[0204] Then, in step S304 after step S302, it is determined whether the provisional gait generation time k precedes 

25 the end time of the gart or not (whether k < Ts + Tcyc). If the result of the detenmination Is YES, the process proceeds 
to a gait instantaneous value determination subroutine of step 8306, where gait instantaneous values are determined. 
Then, the process of the gait generation device 100 proceeds to step 8308. where the provisional gait generation time 
k is incremented by Ak. and then, the process returns to step S304. 

[0205] Here, Ak is an interval between provisional gait generations and may generally be the same as the control 
30 cycle At. If the dynamical precision of the provisional gait can be lowered, Ak may be set longer than At for reducing 

the calculation amount. 

[0206] If the result of the determination in step 8304 is NO, the process proceeds to step 8310. By the process 
described above, the normal gait Is generated from the start to the end thereof before the process proceeds to step 
S310. 

35 [0207] Details of the gait instantaneous value determination subroutine of step S306 will be described with reference 

to Figure 21 . 

[0208] First, in step 8400 in Figure 21 , based on the normal gait parameters (floor reaction force's vertical component 
trajectory parameters), the value (current time value) of the desired floor reaction force's vertical component at the 
time k shown in Figure 16 is determined. Furthermore, in step S402, based on the normal gait parameters (ZMP 
40 trajectory parameters), the value (current time value) of the desired ZMP trajectory at the time k shown in Figure 1 8 is 
determined. 

[0209] Then, the process proceeds to step S404, where based on the normal gait parameters (the foot trajectory 
parameters, the reference body posture trajectory parameters and the arm posture trajectory parameters), the values 
(current time values) of the desired feet positions/postures (desired foot positions/postures of the supporting leg and 

45 the free leg), the reference body posture and the desired arm posture at the time k are determined. More specifically, 
as for the desired arm posture, the total center-of-gravity position of the both arms is determined, although the move- 
ment (swing movement) of the arm involving a change of angular momentum about the vertical axis (or body trunk 
axis) is not detennined yet, The current time value (value at the time k) of the desired foot position/posture is determined 
in the same manner as the foot position/posture at the initial time Ts determined in step S200 In Figure 1 9. 

50 [0210] Then, the process proceeds to step S406, where the value (current time value) of the total center-of -gravity 
vertical position/velocity at the time k that provides the desired floor reaction force's vertical component (i.e., brings 
the sum of the vertical inertial force- of the robot 1 and the gravity into balance with the desired floor reaction force's 
vertical component) is calculated. Specifically, based on the formulas 01 and 04 concerning the dynamics model in 
Figure 10, for example, the total center-of-gravity vertical position/velocity is calculated. That is, according to the for- 

55 mulas 01 and 04, there is provided a fonnula (equation of motion concerning the total center of gravity of the robot 1 
in the vertical direction) that represents that the total mass of the robot 1 multiplied by the sum of the total center-of- 
gravity vertical acceleration due to the movement of the robot 1 and the gravitational acceleration equals to the floor 
reaction force's vertical component. Thus, from the fonnula and the desired floor reaction force's vertical component, 
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the total center-of-gravity vertical acceleration is determined, 

[0211] This fornnula itself generally holds without depending on the model of the robot 1 Then, the total vertical 
acceleration thus determined is integrated, thereby calculating the total center-of-gravity vertical velocity, and the total 
center-of-gravity vertical velocity is further integrated, thereby calculating the total center-of-gravity vertical position. 
5 More generally, these calculations are performed using the dynamical formulas represented by the following formulas 
15 and 16 (discrete versions of the Newlon's equation of motion). 

total center-of-gravity vertical velocity at the time k 

10 

= total center-of-gravity vertical velocity at the time (k-Ak) 
+ ((floor reaction force's vertical component/total mass of 
the robot) + gravitational acceleration) * Ak 
(The gravitational acceleration is a negative value.) formula 15 

total center-of-gravity vertical position at the time k 
= total cenler-of-gravilyvertical position at the lime (k-Ak) 



+ total center-of-gravity vertical velocity at the time k * 

25 



Ak formula 1 6 



[0212] Then, the process proceeds to step S408, where the body vertical position that provides the total center-of- 
gravity vertical position is calculated. Specifically, using the formula 04 concerning the model In Figure 10, the total 

30 center-of-gravity vertical position is calculated. That is, from the current values of the desired foot positions/postures 
of the supporting leg and the free leg, the vertical positions of the supporting leg material particle 2m and the free leg 
material particle 2m in the model in Figure 10 are determined. Then, these vertical positions of the supporting leg 
material particle 2m and the free leg material particle 2m and the current value of the total center-of-gravity vertical 
position determined in step S407 are applied to the formula 04, thereby determining the vertical position of the body 

35 material particle 24m. Furthermore, the body vertical position is determined from the vertical position of the body ma- 
terial particle 24m and the current value of the desired body posture angle (the current reference body posture angle 
set in step S404 or the last time desired body posture angle (at the time k-Ak) determined in step S414 described later). 
[0213] Alternatively, a more precise model (for example, a model in which a material particle is given to each link of 
the robot 1 as shown in Figure 1 1 ) may be used to determine the body vertical position. In this case, the body vertical 

40 position is determined in such a manner that the total center-of-gravity vertical position agrees with the current time 
value of the total center-of-gravity vertical position determined as described above. Here, the total center-of-gravity 
vertical position is determined by the current time value of the desired feet positions/postures determined as described 
above (value at the time k), the desired body posture at the time (k-Ak) (or current time value of the reference body 
posture determined as described above), the current time value of the desired arm posture determined as described 

45 above (position of the center of gravity of the arms), the body horizontal position at the time (k-Ak) and the body vertical 
position to be determined. 

[0214] In this case, the body posture and the body honzontal position at the time k are undetermined, and therefore, 
the values thereof at the time (k-Ak) are used instead thereof. For a higher precision, the estimated values thereof at 
the time k may be determined from the gait state at the time (k-Ak) by extrapolation. 
50 [0215] Then, the process proceeds to step S41 0, where based on the gait parameters (parameters defining the floor 
reaction force's horizontal component allowable range) determined in step S108 in Figure 14, the value (current time 
value) of the floor reaction force's horizontal component allowable range [Fxmin, Fxmax] at the time k shown in Figure 
17 is determined. 

[021 6] Then , the process proceeds to step S41 2, the current time values of the body horizontal acceleration and the 
55 body posture angular acceleration are determined in such a mannerthatthe dynamical equilibrium condition concerning 
the desired ZMP (condition that the horizontal component of the moment caused about the desired ZM P by the resultant 
force of the inertial force of the robot 1 and the gravity is 0) is satisfied. However, the body horizontal acceleration and 
the body posture angular acceleration are determined in such a manner that the floor reaction force's horizontal com- 
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ponent Fx doesn't exceed the range [Fxmin, Fxmax] and an equal body posture angular velocity is provided at the start 
and the end of the nornnal gait. Details thereof will be described below. 

[021 7] Since the instantaneous values (current time values) of the foot position/posture and the body vertical position 

have been determined as described above at this point in time, the desired movement of the robot 1 except for the 
5 degree of freedom of the movement of the arm that involves a change of the angular momentum about the vertical 
axis can be determined uniquely by determining the body horizontal position and the body posture angle, Therefore, 
if the body horizontal position and the body posture angle are determined, all the quantities concerning the floor reaction 
force are uniquely detemnlned except for the moment of the floor reaction force about the vertical axis. In this embod- 
iment, the desired floor reaction force's vertical component and the desired ZMP for the normal gait are defined by the 
10 floor reaction force's vertical component trajectory parameters and the desired ZMP trajectory parameters determined 
in step S022 in Figure 12, respectively. Therefore, of the quantities concerning the floor reaction force, only the floor 
reaction force's hohzontal component is determined depending on the body horizontal position and the body posture 
angle determined, in addition, as described above, since the robot 1 has six degrees of freedom for each leg, the 
positions/postures of the parts of each leg 2 are uniquely determined from the desired foot position/posture and the 
15 desired body position/posture. The degree of freedom of the movement of the arm that Involves a change of the angular 
momentum about the vertical axis is used to cancel a spinning force, as described later 

[0218] In gait generation, if the desired ZMP is provided (the horizontal component of the floor reaction force moment 
about the desired ZMP is brought to 0) using primarily the body rotation mode rather than the body translation mode, 
there arises a possibility that the body posture angle fluctuates too largely. Thus, to avoid this, the body translation 

20 mode should be used as far as circumstances permit. However, since the body translation mode Involves a change of 
the floor reaction force's horizontal component, in the case where the floor reaction force's horizontal component al- 
lowable range is narrow, there is a possibility that the robot slips if the body translation mode works intensely. In such 
a case, the body rotation mode has to be used. In particular, in a period in which the floor reaction force's horizontal 
component allowable range is 0 as in the case of the running gait, such a gait that produce a floor reaction force's 

25 horizontal component cannot be generated, and thus, the body rotation mode has to be used. In view of the points 
described above, in this embodiment, the body horizontal acceleration and the body posture angular acceleration are 
determined according to the flowchart shown in Figure 22. 

[0219] First, instepSSOO, a time Tm is set. The time Tm is an instantwhen the floor reaction force's vertical component 
has Increased to a predetermined level during a second turning gait after the initial time Ts and the floating period of 
30 a first turning gait. In addition, there is set a time Ts2 at which the floor reaction force's vertical component has decreased 
to some degree in the latter half of the second turning gait. In addition, there is set a timeTm2 at which the floor reaction 
force's vertical component has increased to a predetermined magnitude in the next first turning gait after the floating 
period In the second turning gait. 

[0220] Figure 1 6 shows these times . The time Tm is preferably set to the Instant when substantially the whole surface 
35 of the sole of the supporting leg's fool 22 comes into contact with the floor or a time immediately after the instant. The 
same holds true for the time Tm2. Besides, the time Ts2 is preferably set to the instant when the foot 22 having been 
in contact with the floor at substantially the whole surface of the sole thereof comes into contact with the floor only at 
the toe thereof or a time immediately before the instant. 

[0221] As for the relationship between the desired ZMP shown in Figure 18 determined in step S1 10 in Figure 14 
40 andthetimcsTm,Ts2andTm2, it is preferably that the time Tm is an instant when the desired ZMP, which has remained 
at an initial position, which is the position of the heel of the supporting leg's foot 22, until substantially the whole surface 
of the sole of the foot 22 comes into contact with the floor, starts moving toward the middle of the supporting leg's foot 
22. The time Ts2 is preferably set to an instant when the desired ZMP is completely shifted to the toe and only the toe 
of the supporting leg's foot 22 is in contact with the floor. In addition, the time Tm2 is preferably set to an instant when 
45 the desired ZMP, which has remained at an initial position, which is the position of the heel of the supporting leg's foot 
22, until substantially the whole surface of the sole of the foot 22 comes into contact with the floor, starts moving toward 
the middle of the supporting leg's foot 22. 

[0222] The reason why these times are determined as described above will be described later. 
[0223] Then, in step S502, it is determined whether the present time k (value indicated by a normal gait generation 
50 timer) lies between the time Ts and the time Tm or between the time Ts2 and the time Tm2. If the result of the deter- 
mination in step S502 is YES, the process proceeds to step 8504, and if the result is NO, the process proceeds to step 
8518. 

[0224] In step S504, the body horizontal acceleration atmp is detenmined which is required to satisfy the current time 
desired ZMP (at the time k) in the case where the angular acceleration for the body rotation mode is set to 0 to make 
55 the robot 1 move in the body translation mode from the last time instantaneous gait state (gait state at the time k-1 ) of 
the robot 1 The value atmp is determined using, for example, the formula 03 concerning the dynamics model shown 
in Figure 10. More specifically, for example, the vertical accelerations of the supporting leg material particle 2m and 
the free leg material particle 2m at the present time k are determined using time series values of the desired foot 
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position/posture determined before the present time k, and the vertical positions of the supporting leg material particle 
2m and the free leg material particle 2m are determined using the (current time) desired foot position/posture at the 
present time k. Besides, the vertical position of the body material particle 24m is determined using the (current time) 
floor reaction force's vertical position at the present time k, and the vertical acceleration of the body material particle 

5 24m at the present time k is determined using time series values of the desired body vertical position determined before 
the present time k. Then, a formula obtained by substituting the determined values into the formula 03 and substituting 
0 for My and d2eby/dt2 in the formula 03 is solved with respect to the body material particle's horizontal acceleration 
d2Xb/dt2, whereby the body material particle's horizontal acceleration d2Xt/dt2 is determined as the body horizontal 
acceleration atmp. Note that it is also possible that, using a more strict dynamics model, the body horizontal acceleration 

10 atmp, which reduces a horizontal component of a floor reaction moment about a desired ZMP to zero, is determined 
in a searching manner. Further, in this embodiment, since the reference body posture is the vertical posture and the 
body posture angular acceleration depending on the reference body posture is 0, the body horizontal acceleration 
atmp is detemnined assuming that the angular acceleration in the body rotation mode is 0. However, in the case where 
the reference body posture trajectory parameters are set so that the reference body posture varies and the reference 

15 body posture angular acceleration at the present time k which depends on the reference body posture has a value 
otherthan 0, the body horizontal acceleration atmp may be determined using the dynamics mode! by setting the angular 
acceleration for the body rotation mode to the value of the reference body posture angular acceleration other than 0 
(for example, the body horizontal acceleration atmp may be detennined in the same manner as described above by 
setting d2eby/dt2 in the fomnula 03 to the value of the reference body posture angular acceleration other than 0). 

20 [0225] Then, the process proceeds to step S506, where the floor reaction force's horizontal component Fxtmp at the 
time k in the case where the body horizontal acceleration is atmp is detennined using the dynamics model. In this 
embodiment, Fxtmp is determined using the formula 02 of the dynamics model. That Is, Fxtmp is determined using the 
following fomriula 17. In this formula, d2Xsup/dt2 and d2Xswg/dt2 represent the supporting leg's foot material particle 
horizontal acceleration and the free leg's foot material particle horizontal acceleration at the time k. respectively. 

25 

Fxtmp mb * atmp + msup * d2Xsup/dt2 

+ mswg * d2Xswg/dt2 formula 1 7 

30 

[0226] An example of Fxtmp thus detemnined is shown in Figure 23. In Figure 23, the shaded areas indicate that 

Fxtmp exceeds the floor reaction force's horizontal component allowable range [Fxmin, Fxmax]. 

[0227] Then, the process proceeds to step S508, where the body horizontal acceleration a for the body translation 

mode, the floor reaction force's horizontal component Fx caused by the body horizontal acceleration, and the body 
35 angular acceleration p for the body rotation mode are determined in the following matter (S508 to S51 6). 
That is, 

If Fxtmp > Fxmax, the process proceeds to step S510, where Fx is detennined by the following formula. 

Fx = Fxmax formula 18 

40 

If Fxtmp < Fxmin, the process proceeds to step S512, where Fx is determined by the following formula. 

Fx = Fxmin formula 1 9 

45 

Otherwise, that is, if Fxtmp lies within the floor reaction force's horizontal component allowable range [Fxmin, Fxmax], 
the process proceeds to step S514, where Fx is determined by the following formula. 

50 

Fx = Fxtmp formula 20 

[0228] In any of the cases, the process then proceeds to step S51 6, where the body horizontal acceleration a and 
the body posture angular acceleration p are determined by the following formulas. 

55 

a ^ atmp + (Fx-Fxtmp)/AFp formula 21 
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p - (cxtmp - a) * AMp/AMr formula 22 

[0229] However, AFp, AMp and AMr are determined by the formulas 06, 07 and 09, respectively. 

5 [0230] For a higher precision of the dynamical calculation, after the body angular acceleration p Is determined as 
described above, the body horizontal acceieration a for the body translation mode is preferably determined in an 
analytic or searching manner using a more precise dynamics model so that a composite movement of the body trans- 
lation mode and the body rotation mode having the body angular acceleration p satisfies the desired ZIVIP. As the 
determination method in a searching manner, the simplex method or a method of determining an affine Jacobian (sen- 

10 sitivity matrix) and determining a next candidate by the pseudo Newton method may be used. 

[0231] Furthermoro. in order to entirely prevent the floor reaction force's horizontal component Fx from exceeding 
the floor reaction force's horizontal component allowable range [Fxmin, Fxmax], asetofthebody horizontal acceleration 
a and the body angular acceleration p may be determined in a searching manner in such a manner that Fx - Fxmax 
and the horizontal component of the floor reaction force moment about the desired ZMP is 0 in step S51 0 or Fx Fxmin 

15 and the horizontal component of the floor reaction force moment about the desired ZMP is 0 in step S512. 

[0232] Fx thus determined is shown in Figure 24. This Fx is Fxtmp that is limited (saturated) not to exceed the floor 
reaction force's horizontal component allowable range [Fxmin, Fxmax]. More specifically, if Fxtmp associated with the 
body horizontal acceleration atmp of the body translation mode falls within the allowable range [Fxmin, Fxmax], Fxtmp 
is adopted as Fx as it is. On the other hand, if Fxtmp associated with the body horizontal acceleration atmp of the body 

20 translation mode is larger than the upper limit of the allowable range [Fxmin, Fxmax] or Is smaller than the lower limit 
thereof, Fx is forcedly limited to Fxmax or Fxmin, respectively. In particular, during the floating period in the running 
gait, since Fxmax and Fxmin are always 0 (Fxmax = Fxmin =0), Fx Is also 0 (Fx = 0). 

[0233] In addition, the body posture angular acceleration p thus detennined is also shown in Figure 25. An insufficient 
floor reaction force moment due to limitation of the acceleration for the body translation mode intended for preventing 

25 Fx caused in the body translation mode from exceeding the allowable range [Fxmin, Fxmax] is compensated for by 
the body rotation mode (specifically, the insufficient floor reaction force moment is the inertia! force moment required 
for providing a horizontal component of the floor reaction force moment about the desired ZMP of 0 minus a moment 
component due to the limited body horizontal movement and the movements of the legs 2, 2). During the floating pehod 
of the running gait, the body horizontal acceleration a of the body translation mode is always limited to 0, and therefore, 

30 the insufficient floor reaction force moment described above is compensated for only by the body posture angular 
acceleration p of the body rotation mode. 

[0234] Described above is the processings performed in the case where the time k lies between the time Ts and the 
time Tm or between the time Ts2 and the time Tm2. 

[0235] If the result of the detemnination in step S5Q2 is NO, the following processings are performed. First, the process 
35 proceeds to step S51 8, where there is set a pattern of a ZMP-converted value of the floor reaction force moment which 
produces a body posture angular acceleration for returning the body posture angular velocity to the initial value (which 
is the value at the time Ts if the present time k is ahead of the time Ts2, or otherwise, the value at the time Ts2) by the 
time Ts2 if the present time k is ahead of the time Ts2, or otherwise, by the time Te (the ZMP-converted value of the 
floor reaction -force moment is referred to as a body posture restoring moment ZMP-converted value and abbreviated 
40 as ZMPrec, hereinaftor). 

[0236] This will be described in detail below. The processings perfonned if the present time k is subsequent to the 
time Tm2 are the same as those performed if the present time k Is ahead of the time Ts2, and therefore, only the 
processings performed if the present time k is ahead of the time Ts2 will be described. 

[0237] It is to be considered to return the body posture angular velocity to the initial value (value at the time Ts) by 
45 producing the body posture angular acceleration using the body rotation mode in a period from the time Tm to the time 
Ts2. A body posture angular acceleration pattern for this is denoted by p(k). 

[0238] In the body rotation mode, when trying to produce the body posture angular acceleration P(k), a floor reaction 
force moment P(k) * AMr is produced. As a result, assuming that the floor reaction force's vertical component at that 
instant is Fz(k), the ZMP(k) calculated from the movement (rather than the desired ZMP) is shifted by AZMP determined 
50 by the following formula. 

AZMP(k) = -p(k) * AMr/Fz(k) formula 23 

55 [0239] Therefore, if the patterns of AMr and F2(k) are detemnined (known), the body posture angular acceleration 
pattern that satisfies the formula 23 can be produced by appropriately setting the pattern of AZMP(k), and thus, the 
body posture angular velocity can be returned to the initial value (value at the time Ts), that is, to the body posture 
angular velocity in the initial state of the reference body posture trajectory (at the time Ts). 
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[0240] The "body posture restoring moment ZMP-converted value (ZMPrec) "means AZMP(k) that is appropriately 
set in this way. Strictly speal<ing, when the body posture restoring moment ZMP-converted value is set using the formula 
23, AMr varies. However it may be set to an approximate constant value. The reason for this is that the normal gait 
doesn't require a quite high dynamical precision because the normal gait generated is a provisional one and the actual 
5 robot doesn't follow the gait. 

[0241] Figure 26 shows an example of ZMPrec. In Figure 26, ZMPrec has a trapezoidal pattern. The times of the 
apexes of the trapezoidal pattern agree with the limes of the apexes of the desired ZMP pattern in the period from the 
time Tm to the time Ts2 (see Figure 1 8). This is intended for simplifying modification of the desired ZMP pattern of the 
current time gait, as described later. If ZMPrec is substitutedf or AZMP(k) in theformula 23, the following formula results. 

10 

p(k) = -ZMPrec * Fz{k)/AMr formula 24 

Therefore, p(k) determined by the formula 24 is as shown by the solid line in Figure 27. The dotted line in Figure 27 

15 shows the body posture angular velocity from the time Ts to the time Tm (shown by the solid line in Figure 25). 

[0242] For the normal gait, the body posture angular velocity at the time Ts2 preferably agrees with the body posture 
angular velocity at the time Ts. This is because such agreement provides reduced variation of the body posture angle. 
[0243] Thus, in order to make the body posture angular velocity at the time Ts2 agree with the body posture angular 
velocity at the tinrie Ts. the body posture angular acceleration pattern is set in such a manner that the integral of the 

20 body posture angular acceleration P for the period from the time Ts to the time Ts2 is 0. That is, the body posture 
angular acceleration pattern is set in such a manner that the integral of p(k) for the period from the time Tm to the time 
Ts2 (i.e., integral for the solid line section in Figure 27) equals to the integral of the body posture angular acceleration 
for the period from the time Ts to the time Tm (determined in steps S504 to S51 6 shown in Figure 22) (i.e., integral for 
the dotted line section in Figure 27, in other words, the difference between the body posture angular velocity at the 

25 time Tm and the body posture angular velocity at the time Ts) multiplied by -1 . 

[0244] More specifically, in this embodiment, in the trapezoidal pattern of ZMPrec shown in Figure 26, by assuming 
that the times of the apexes of the trapezoid (detennined based on the desired ZMP trajectory for the normal gait as 
described above) are known, and the height of the trapezoid is unknown, the height of the trapezoid of ZMPrec that 
satisfies the above-described relationship (parameter that defines the ZMPrec pattern) can be determined. 

30 [0245] The height of the trapezoid of ZM Prec for the first turning gait is referred to as a first turning gait's body posture 
restoring moment's ZMP-converted value's trapezoid height acycl . The height of the trapezoid of ZMPrec for the second 
turning gait is referred to as a second turning gait's body posture restoring moment's ZMP-converted value's trapezoid 
height acyc2. ZMPrec tor the second tuming gait Is a trapezoidal pattern set in the period from the time Tm2 to the 
time Te. 

35 [0246] Furthermore, as far as the gait parameters are not changed in the process of generation of one step of the 

current time gait, the ZMPrec patterns for the period between the time Tm and the time Ts2 and the period between 
the time Tm2 and the timeTe determined in step S518 are the same (i.e., the same parameter values are calculated), 
and therefore, the processing of step S518 may be performed only at the times Tm and Tm2. 

[0247] Then, the process proceeds to step S520, where the instantaneous value (current time value) of the body 
40 posture restoring moment's ZMP-converted value ZMPrec at the time k is calculated based on the parameter (trapezoid 

height) determined as described above. 

[0248] Then, the process proceeds to step S522, where the instantaneous value (current time value) p of the body 
posture angular acceleration pattern at the time k is calculated using the formula 24. 

[0249] Then , the process proceeds to step S524, where the body horizontal acceleration atmp required for satisfying 
45 the current time (time k) desired ZMP in the case where the robot moves only in the body translation mode without the 

movement in the body rotation mode from the last time instantaneous desired gait state (desired gait state at the time 
k-1) is detennined using the dynamics model of the robot 1. This calculation is performed in the same manner as in 
step S504. 

[0250] Then, the process proceeds to step S526, where the body horizontal acceleration a for the body translation 
50 mode is calculated using the following formula. 

a = atmp - (AMr/AMp) * p forrhula 25 

55 [0251] Then, the process proceeds to step S528, where the floor reaction force's horizontal component Fx at the 
time k for the body horizontal acceleration of a is determined using the following formula 26 similar to the formula 1 7. 
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Fx ~ mb * a + msup * d2Xsup/dt2 

+ mswg * d2Xswg/dt2 formula 26 

5 

[0252] incidentally, for a higher precision of the dynannical calculation, after the body angular acceleration p is de- 
termined as described above, instead of calculating the body horizontal acceleration u using the formula 25 in step 
S526, the body horizontal acceleration a for the body translation mode is preferably determined in an analytic or search- 
ing manner using a more precise dynamics model so that a composite movement of the body translation mode and 
10 the body rotation mode having the body angular acceleration p satisfies the desired ZMP, as supplementaly described 
concerning step S516. 

[0253] Described above is the processings performed in the case where the time k Is not included in any of tho 
periods between the time Ts and the time Tm and between the time Ts2 and the time Tm2. 

[0254] The floor reaction force's horizontal component Fx provided when the above-described processings to the 
15 time Ts2 are completed is shown in Figure 28. In addition, the floor reaction force's horizontal component Fx and the 
body posture angular acceleration p provided when the above-described processings to the time Te are completed are 
shown in Figures 29 and 30. respectively. The processing of step S412 described above (subroutine for determining 
the body horizontal acceleration and the body posture angular acceleration) is to determine the instantaneous values 
of the body horizontal acceleration and the body posture angular acceleration at the time k, rather than to collectively 
20 generate the time series values thereof to the time Te. 

[0255] In this embodiment, since the reference body posture is the vertical posture, and the body posture angular 
acceleration depending on the reference body posture is 0, the angular acceleration p for the body rotation mode 
determined as described above Is regarded as the body posture angular acceleration determined in the processing of 
step S412. However if the reference body posture trajectory parameters are set in such a manner that the reference 
25 body posture varies, the sum of the angular acceleration p for the body rotation mode determined as described above 
and the reference body posture angular acceleration should be regarded as the body posture angular acceleration 
determined in the processing of step S412. 

[0256] The times Ts, Tm, Ts2 and Tm2 are set as described above to prevent the floor reaction force's horizontal 
component Fx from exceeding the allowable range [Fxmin, Fxmax] even if the body posture angular acceleration p is 

30 produced so as to return the body posture angular velocity to the initial angular velocity of the reference body posture 
trajectory in the periods between the time Tm to the time Ts2 and between the time Tm2 and the time Te. In other 
words, during the periods from the time Tm to the time Ts2 and from the time Tm2 to the time Te^ the floor reaction 
force's horizontal component allowable range Is sufficiently wide, and therefore, even if the body posture angular ac- 
celeration p is produced to return the body posture angular velocity to the initial value while satisfying the desired ZMP, 

35 the floor reaction force's horizontal component Fx doesn't exceed the allowable range. 

[0257] Alternatively, rather than making the body posture angular velocity at the time Ts agree with the body posture 
angular velocity at the time Ts, assuming that acyd and acyc2 have an equal value (assuming that acyd = acyc2), 
the value of acyd and acyc2 may be determined so as to make the body posture angular velocity at the timeTe agree 
with the body posture angular velocity at the time Ts. 

40 [0258] Then, the process proceeds to step S414 in Figure 21 , where the body horizontal velocity is determined by 
integrating the body horizontal acceleration determined in step S412 (cumulatively summing the body horizontal ac- 
celeration values from the time Ts to the present time k), and the body horizontal position (current time value) is de- 
termined by Integrating the body horizontal velocity (cumulatively summing the body horizontal velocity values from 
the time Ts to the present time k). In addition, the body posture angular velocity is determined by integrating the body 

45 posture angular acceleration determined in step S412 (cumulatively summing the body posture angular acceleration 
values from the time Ts to the present time k). and the body posture angle (current time value) is determined by inte- 
grating the body posture angular velocity (cumulatively summing the body posture angular velocity values from the 
time Ts to the present time k). 

[0259] After the normal gait's instantaneous value detennination subroutine of step S306 in Figure 20 is conducted 
50 as described above, the process proceeds to step S308, where the value of the gait generation time k is incremented 
by the gait generation interval Ak. Then, the process returns to step S304, and as far as the condition shown in step 
S304 is satisfied, the processings of steps S306 and S608 are repeated. If the condition shown In step S304 is not 
satisfied, that is, if the generation of the provisional nomnal gait to the end thereof (to the time Te = Ts + Tcyc) is 
completed, the process proceeds to step S310. In step S310, the initial (time Ts) body posture angle and the initial 
55 (time Ts) body posture angular velocity are modified in accordance with the following formulas based on the final (time 
Te) body posture angle of the provisional gait detemnined as described above or the like. This modification is intended 
for satisfying the boundary requirements of the normal gait concerning the body posture angle and the angular velocity 
thereof (that Is, both the body posture angle and the angular velocity thereof are the same at the start and the end of 
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the normal gait) . In this description ., it is assunned that the gait of the robot 1 is one with which the robot 1 nnoves straight. 
[0260] In this case, renewed values in the following formulas are the modified values. 

renewed initial body posture angular velocity 
= initial body posture angular velocity for the 
provisional gait 
- (final body posture angle for the provisional gait 
- initial body posture angle for the provisional 

gait)/Tcyc formula 30 

renewed initial body posture angle ~ initial (time Ts) 

reference body posture angle fornnula 31 



[0261 ] Now, a reason why the initial state posture angular velocity is modified using the formula 30 will be described 
below. For the normal gait, the initial state posture angle and the angular velocity thereof have to be determined to 
avoid the movement of the robot 1 from being discontinuous at the boundaries between the gaits when the gait is 

25 repeated (to satisfy the boundary requirements). In this case, the final body posture angular velocity for the provisional 
normal gait thus determined agrees with the initial body posture angular velocity's initial value (reference body posture 
angular velocity's initial value) since the body posture angular acceleration pattern associated with the body posture 
restoring moment ZMP-converted value ZMPrec Is set. Therefore, if the following formula, which is the remaining 
requirement, Is satisfied, the above-described requirements concerning the body posture angle and the angular velocity 

30 thereof are satisfied. 

final body posture angle = initial body posture angle formula 32 

35 [0262] In addition, there is a relationship expressed by the following formula. 

second order differential of the body posture angle = body 

posture angular acceleration formula 33 

Therefore, second-order integrating the both sides of the formula 33 for the period from the start to the end of the 
normal gait provides the following relationship. 

final body posture angle = initial body posture angle 

+ initial body posture angular velocity * Tcyc 
+ second order integral of the body posture angular 

acceleration formula 34 

[0263] On the other hand, in normal gait generation, the horizontal acceleration (horizontal acceleration/deceleration) 
55 of the body 24 is adjusted using primarily the body translation mode for satisfying the desired ZMP as described above. 
However, if the horizontal acceleration of the body 24 that satisfies the desired ZMP cannot produced adequately (if 
a sufficient friction force cannot be produced), the insufficient body horizontal acceleration for the body translation 
mode Is compensated for by adjusting the angular acceleration of the body posture angle while keeping constant the 
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total center-of-gravity acceleration using the body rotation mode. 

[0264] The adjustment of the body posture angular acceleration using the body rotational movement mode is ap- 
proximately equivalent to adjustment of the angular acceleration of the flywheel FH of the robot 1 shown in Figure 10. 
If the rotational velocity of the flywheel FH is close to 0; no gyro effect occurs, and the force caused by the flywheel 

5 FH is determined only by the angular acceleration of the flywheel FH, Therefore, in the robot 1 having the flywheel FH 
in the body 24. even if the initial angle and the initial angular velocity of the flywheel FH vary slightly, substantially 
constant force is produced as far as the flywheel FH moves with an angular acceleration of a same pattern. Therefore, 
in the formulas 01, 02 and 03, which are robot dynamics equations, the gyro effect is neglected. Therefore, for the 
robot 1 according to this embodiment, according to any of the formulas 01 , 02 and 03 and a more general and precise 

10 dynamics model, even when the initial body posture angle and the initial angular velocity vary slightly, substantially the 
same resultant force of the inertia! force and the gravity is produced as far as the body posture angle is changed with 
an angular acceleration of a same pattern while maintaining a constant total center-of-gravity acceleration (that is, as 
far as the body posture angle is changed with an angular acceleration of a same pattern in the body rotational m.ovement 
mode), in other words, even if the initial body posture angle andthe initialangularvelocity vary slightly, the body posture 

15 angular acceleration for the gait generated according to the flowchart described above is not changed. 

[0265] That is. the second order integral of the body posture angular acceleration in the formula 34 is independent 
of the initial body posture angle and the initial angular velocity. That is, the second order integral of the body posture 
angular acceleration in the formula 34 can be treated as a constant value regardless of the values of the initial body 
posture angle and the initial angular velocity. 

20 [0266] Since the final body posture angle is the final body posture angle for the provisional gait when the value of 
the initial body posture angle is the initial body posture angle for the provisional gait, and the value of the initial body 
posture angular velocity is the initial body posture angular velocity for the provisional gait, applying this relationship to 
the formula 34 results in the following formula. 

25 

final body posture angle for the provisional gait ^ initial 
body posture angle for the provisional gait 
^ + second order integral of the body posture angular 

acceleration 
+ initial body posture angular velocity for the 

provisional gait * Tcyc formula 35 

Thus, the following formula results. 
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second order integral of the body posture angular acceleration 
^ (final body posture angle for the provisional gait 
- initial body posture angle for the provisional gait) 
- initial body posture angular velocity for the 

provisional gail * Tcyc formula 36 

Since, from the above discussion, it is seen that the second order integral of the body posture angular acceleration 
can be treated as a constant (the second order integral of the body posture angular acceleration is independent of the 
initial body posture angle and the initial angular velocity), substituting the above formula into the formula 34 results in 
the following fomnula. 

final body posture angle = initial body posture angle 
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+ (final body posture angle for the provisional gait 
- initial body posture angle for the provisional gait) 

- initial body posture angular velocity for the 
provisional gait * Tcyc 

+ initial body posture angular velocity * Tcyc formula 37 



From the formulas 37 and 32, the above-described fonnula 30 is provided. 

[0267] In this embodiment, the initial body posture angle the initial body posture angle agrees with the initial value 
of the reference body posture angle as expressed by the fonnula 31 . However the initial body posture angle may be 

15 set so that the average value of the body posture angles for the normal gait agrees with the initial value of the reference 
body posture angle. Alternatively, the initial body posture angle may be set so that the average value of the maximum 
and the minimum of the body posture angle tor the normal gait agrees with the initial value of the reference body angle. 
[0268] Furthermore, while a case where the robot 1 moves only straight is described above when determining a 
normal gait including a turning movement, the robot 1 travels in different directions at the start and the end of the normal 

20 gait. Therefore, the initial body posture angular velocity depends on the initial body posture angle. Therefore, the initial 
body posture angle and the initial angular velocity have to be determined considering this fact. In this case, for example, 
the initial body posture angle and the initial body posture angular velocity may be updated so that the following formulas 
37a and 37b are satisfied. 



final body posture angle - initial body posture angle 
= second order integral of the body posture angular 
acceleration detemnined so as to satisfy the floor reaction 
force's horizontal component allowable range 
+ second order integral of the body posture angular 

acceleration caused by ZMPrec 
+ initial body posture angular velocity * period of the 

normal gait formula 37a 

final body posture angular velocity - initial body posture 
angular velocity 
= first order integral of the body posture angular 
acceleration determined so as to satisfy the floor reaction 

50 

force's horizontal component allowable range 
+ first order integral of the body posture angular 

acceleration caused by ZMPrec fonnula 37b 

[0269] For the formulas 37a and 37b, the integral time for the first term In the right side thereof Is a sum of the period 
from the lime Ts lo the time Tm and the period from the lime Ts2 to the lime Tm2, and the integral lime for the second 
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term in the right side thereof is a sum of the period from the time Tm to the time Ts2 and the period from the time Tm2 

to the time Te. 

[0270] More specifically, in the normal gait, the initial state posture angle and the Initial state angular velocity seen 
from the first turning gait's supporting leg coordinate system (next time gait's supporting leg coordinate system) have 
to agree with the final body posture angle and the final angular velocity seen from the next first turning gait's supporting 
leg coordinate syslem (next bul Iwo gait's supporting leg coordinate system), respectively. Thus, in this embodiment, 
the renewed initial body posture angle is determined by the formula 31, and the renewed initial body posture angle 
and a value seen from the next turning gait's supporting leg coordinate system derived from the renewed initial body 
posture angle by coordinate transformation thereof using a matrix corresponding to the total turning angle of the robot 
1 in the normal gait (turning angle about the vertical axis) (rotating coordinate transformation matrix) are substituted 
for the initial body posture angle and the final body posture angle in the left side of the formula 37a, respectively. 
Besides, as the body posture angular acceleration concerning the integration in the first term of the right side of each 
of the fonnulas 37a and 37b, the one determined successively In step S516 in Figure 22 is used. 
[0271] Then, assuming that the initial body posture angular velocity in the formulas 37a and 37b and the trapezoid 
height of ZMPrec (the trapezoidal pattern shown in Figure 26) concerning the integration In the second term of the 
right side of the formulas 37a and 37b are unknown quantities (where the times of the apexes of the ZMPrec trapezoidal 
pattern are previously determined, and the trapezoid height acyci of ZMPrec for the first turning gait equals to the 
trapezoid height acyc2 of ZMPrec for the second turning gait), the simultaneous equations 37a and 37b including these 
unknown quantities are solved to determine the initial body posture angular velocity as the renewed initial body posture 
angular velocity. In this case, the final body posture angular velocity in the formula 37b is a value seen from the next 
time gait's supporting leg coordinate system derived from the unknown initial body posture angular velocity by coordi- 
nate transformation using the matrix corresponding to the total turning angle in the normal gait. 
[0272] In the case where the robot 1 makes a movement including turning, the renewed initial body posture angle 
and the renewed initial angular velocity may be determined as described above. 

[0273] The initial body posture angular velocity that satisfies the boundary requirements of the nonnal gait may be 
determined in a searching manner. 

[0274] After the processing of step S310 in Figure 20 is completed, the process proceeds to step S210 in Figure 19, 
where the final body horizontal position/velocity for the gait generated (provisional normal gait) are converted into 
values seen from a supporting leg coordinate system associated with the supporting leg at that instant (that is, X'", Y'", 
Z"' coordinate system in Figure 31 ), and the values are denoted by (Xe, Vxe) where Xe denotes a final body horizontal 
position and Vxe denotes a final body horizontal velocity. 

[0275] Then, the process proceeds to step S212, where the difference between the initial body horizontal position/ 
velocity (Xs, Vxs) and the final body horizontal position/velocity (Xe, Vxe) Is calculated as shown In the drawing. The 
difference (Xs-Xe, Vxs-Vxe) is referred to as a body horizontal position/velocity boundary requirement error (errx, 
errvx). Since the boundary requirements have to be satisfied in the normal gait, (xs, Vxs) has to agree with (Xe, Vxe). 
Therefore, the body horizontal position/velocity boundary requirement error (errx, errvx) has to be 0 or approximately 
0. In this embodiment, (Xs, Vxs) that provides a body horizontal posit ion/ velocity boundary requirement error (errx, 
errvx) of approximately 0 is detennined in a searching manner as described below 

[0276] Then, the process proceeds to step S214, where it is determined whether the calculated body horizontal 
position/velocity boundary requirement error (errx, errvx) falls within an allowable range previously appropriately set. 
Instead of setting the allowable range for the body horizontal position/velocity boundary requirement error as described 
above, it may be determined whether the difference between the initial divergence component (Xs+Vxs/coO) and the 
final divergence component (Xe+Vxe/o>0) and the difference between the initial convergence component (Xs-Vxs/o>0) 
and the final convergence component (Xe-Vxe/a>0) fall within respective allowable ranges. As described earlier, oiO is 
a predetemilned value. 

[0277] If the result of the determination in step S214 is NO, the process proceeds to step S216. In step S216, a 
plurality of (two, in this embodiment) Initial value candidates (Xs+AXs, Vxs), (Xs, Vxs+AVxs) are detennlned In the 
vicinity of (Xs, Vxs). Here, AXs and AVxs mean a predetermined small variations of Xs and Vxs, respectively. Assuming 
that each of these initial value candidates is an initial state of the body horizontal position/velocity, a nomial gait is 
generated using gait parameters in the same manner as in the processing of step S208. Furthermore, values (Xe+AXel , 
Vxe+AVxel) and (Xe+AXe2, Vxe+AVxe2) seen from the supporting leg coordinate system (X'", Y"V z'" coordinate 
system in Figure 31) associated with the supporting leg at that instant converted from the final body position/velocity 
of the generated normal gait are detemilned. Here, (Xe+AXel , Vxe+AVxel ) indicates the final body position/velocity 
corresponding to (Xs+AXs, Vxs), and (Xe+AXe2, Vxe+AVxe2) indicates the final body position/velocity corresponding 
to (Xs, Vxs+AVxs). In this processing of normal gait (provisional gait) generation, the initial states (states at the time 
Ts) of the variables other than the body horizontal position/velocity may be set the same as in the case where the initial 
value candidate of the body horizontal position/velocity is (Xs, Vxs), for example. In step S21 6, in addition , the difference 
between each initial value candidate and the final body position/velocity corresponding thereto, that Is, the body hori- 
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zontal position/velocity boundary requirement error for each of the initial value candidates (Xs+AXs, Vxs) and (Xs, 
Vxs+AVxs) is determined in the same processing as that of step S210. 

[0278] Then, the process proceeds to step S218, where based on the body honzontal position/velocity boundary 
requirement error for each of (Xs, Vxs) and the initial value candidates in the vicinity thereof (Xs+AXs, Vxs) and (Xs, 

5 Vxs+AVxs), an initial value candidate following (Xs, Vxs) is determined by a searching method (forexample, the simplex 
method or a method of determining an affine Jacobian (sensitivity matrix) and determining a next candidate by the 
steepest descent method). That is, from the body horizontal position/velocity boundary requirement error for each of 
(Xs, Vxs) and the initial value candidates in the vicinity thereof (Xs+AXs, Vxs) and (Xs, Vxs+AVxs), a sensitivity matrix 
that indicates the degree of change of the body horizontal position/velocity boundary requirement error caused when 

10 the body horizontal position and the body horizontal velocity are each slightly changed from the initial value candidates 
Xs and Vxs, respectively, and based on the sensitivity matrix, an initial value candidate (Xs, Vxs) that provides further 
reduced body horizontal position/velocity boundary requirement error is newly determined. Then, once the new initial 
value candidate (Xs, Vxs) forth© body honzontal positionA/elocity is detennined, the process returns to step S206. 
[0279] As far as the result of the determination in step S214 is NO, the processings described above (steps S206 

15 to S21 8) are repeated. In this case, in step S300 (see Figure 20) in the process of nonnal gait generation (step S208) 
for the new initial value candidate (Xs, Vxs) of the body horizontal position/velocity, the initial value of the body posture 
angular velocity is set to the value determined in step S31 0 (see Figure 20) in the processing of step S208 for the last- 
time's initial value candidate (Xs, Vxs) of the body horizontal positionA/elocity, rather than the initial value of the refer- 
ence body posture angular velocity. Then, if the result of the determination in step S214 is YES, the repetition loop 

20 (step S204) is exited, and the process proceeds to step S220. The provisional normal gait generated immediately 
before exiting the repetition loop of step S204 is adopted as the nonnal gait that satisfies the boundary requirements. 
[0280] In step S220, the initial body horizontal position/velocity (XO, VO) at the original initial time 0 (end time of the 
current time gait), the initial body vertical position/velocity (ZO, VzO) at the initial time 0, and the initial body posture 
angle and the initial angular velocity at the initial time 0 are determined. 

25 [0281] Specifically, (XO, VO) and (ZO, VzO) are set to values seen from the supporting leg coordinate system (X" 
Y" ', Z" ' coordinate system in Figure 31 ) for the supporting leg for a step starting at the time Tcyc (that is, the second- 
time first turning gait) which are converted from the body horizontal position/velocity and the body vertical position/ 
velocity detennined at the instant when switching from the second turning gait to the second turning gait occurs in 
steps S408 and S414 in the nonnal gait instantaneous value determination subroutine shown in Figure 21 , that is, at 

30 the time k = Tcyc (time Te-Ts). Similarly, the initiai state posture angle and the initial state angular velocity are set to 
values seen from the supporting leg coordinate system (X" ', Y" Z" ' coordinate system in Figure 31) for the supporting 
leg fox a step starting at the time Tcyc (that is, the second-time first turning gait) which are converted from the body 
posture angle and the angular velocity determined at the time k = Tcyc (time Te-Ts). 

[0282] Then, the process proceeds to step 8222, where the normal gait's initial divergence component q[0] is deter- 
35 mined by the following formula. 

q[0] - XO + VO/ioO formula 40 

40 As described in the explanation about divergence, o>0 is a predetermined value. 

[0283] Then, the process proceeds to step S224, where the normal gait's initial divergence component q[0] is con- 
verted into a value seen from the current time gait's supporting leg coordinate system, and the resulting value is de- 
termined as q"[0]. The initial body vertical position/velocity (ZO, VzO) is converted into a value seen from the current 
time gait's supporting leg coordinate system, and the resulting value is determined as (ZO", VzO"). 

45 [0284] Specifically, (ZO", VzO") agrees with the body vertical position/velocity at the end of the second turning gait 
seen from the second turning gait's supporting leg coordinate system (X", Y", Z" coordinate system in Figure 15). 
Besides, q"[0] also agrees with the final divergence component of the second turning gait seen from the second turning 
gait's supporting leg coordinate system (X", Y", Z" coordinate system in Figure 15). Therefore, (ZO", VzO") and q" fOl 
may be calculated using these characteristics. 

50 [0285] Then, the processing of step S024 in Figure 1 2, that is, the subroutine processing for detemnining the initial 
states of the normal gait, is completed. 

[0286] Then, the process proceeds to step S026 in Figure 12, where the gait parameters for the current time gait 
are determined (some of them are provisionally determined). In step S026, a process described below is conducted 
in accordance with the flowchart shown in Figure 32, 
55 [0287] First, in step S600, the foot trajectory parameters for the current time gait are set in such a manner that the 
foot position/posture trajectory for the current time gait connects to the foot position/posture trajectory for the normal 
gait. 

[0288] Specifically, the current time gait's free leg's foot position/posture (initial valu© of the current time gait's free 
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leg's foot position/posture) is set to the current free leg position/posture seen from the current time gait's supporting 
leg coordinate system (free leg position/posture at the end of the last time gait). The supporting leg's foot position/ 
posture at the start of the current time gait (initial value of the current time gait's supporting leg's foot position/posture) 
Is set to the current supporting leg's foot position/posture seen from the current time gait's supporting leg coordinate 

5 system(supporting leg's foot position/gosture at the end of the last time gait). In addition, the free leg's foot position/ 
posture at the end of the currenUime gait is determined in accordance with the next time gait's supporting leg coordinate 
system seen from the current Lime gait's supporting leg coordinate system (that^ is. in accordance with the required 
value of the free leg landing position/posture forthe first step of the current time gait). That is, the free leg's foot position/ 
posture at the end of the current time gait Is determined in such a manner that^ when the free teg's foot 22 is rotated 

10 from the free leg's foot position/posture at the end of the current time gait until substantially the whole surface of the 
sole of the foot 22 comes into contact with the floor while keeping the foot in contact with the floor without slipping, the 
representative point of the foot 22 agrees with the origin of the next time gait's supporting leg coordinate system seen 
from the current time gait's supporting leg coordinate system. 

[0289] At the end of the current time gait, the supporting teg's foot 22 is away from the floor and floats in the air. To 
15 determine the trajectory after the supporting leg's foot 22 takes off the floor the expected landing position/posture of 
the supporting leg's foot is set. The expected landing position/posture of the supporting leg's foot is set in accordance 
with the next but one time gait's supporting leg coordinate system seen from the current time gait's supporting leg 
coordinate system (that is, in accordance with the required value of the free leg's foot position/posture for the second 
step of the current time gait). More specifically, the expected landing position/posture of the supporting leg's foot is set 
20 In such a manner that, when the foot 22 is rotated from the position/posture until substantially the whole surface of the 
sole of the foot 22 comes into contact with the floor while keeping the foot 22 in contact with the floor without slipping, 
the representative point of the foot 22 agrees with the origin of the next but one time gait's supporting leg coordinate 
system seen from the current time gait's supporting leg coordinate system. 

[0290] The supporting leg's foot position/posture at the end of the current time gait is determined using the finite 
25 duration settling filter to generate, until the end of the current time gait, the foot position/posture trajectory that leads 
from the current supporting leg position/posture (supporting leg's foot position/posture at the start of the current time 
gait) to the expected foot landing position/posture associated with the next time gait's supporting leg coordinate system 
(required value of the free leg's foot landing position/posture for the second step of the required parameters). 
[0291] Then, the process proceeds to step S602, where the reference body posture trajectory parameters for the 
30 current time gait are determined in the same manner as the first and second turning gaits of the normal gait. However, 
the parameters are set in such a manner that the reference body posture trajectoryforthe current time gait is seamlessly 
connected to the reference body posture trajectory for the normal gait (that is, the reference body posture angle and 
the angular velocity at the end of the current time gait agree with the reference body posture angle and the angular 
velocity at the start of the normal gait, respectively). In this embodiment, both for the current time gait and the normal 
35 gait, the reference body posture is constantly the vertical posture. 

[0292] Then, the process proceeds to step S604, where the ann posture trajectory parameters for the current time 
gait are determined in the same manner as the first and second turning gaits of the normal gait. The parameters are 
set in such a manner that the ami posture trajectory for the current time gait is continuously connected to the arm 
posture trajectory for the normal gait. The arm posture trajectory parameters determined in this step are movement 
parameters other than the parameter concerning a change of the angular momentum of the anns about the vertical 
axis (or body trunk axis), which define the trajectory of the position of the center of gravity of the arms, as with the 
normal gait parameters determined in step S104 In Figure 14. 

[0293] Then, the process proceeds to step S606, where the floor reaction force's vertical component trajectory pa- 
rameters for the current time gait are set in such a manner that the floor reaction force's vertical component trajectory 
45 defined by the parameters is substantially continuous (i.e., has no step-wise discrete values) as shown in Figure 6, as 
with the first and second turning gaits of the normal gait. 

[0294] The floor reaction force's vertical component trajectory parameters are set in such a manner that both the 
total center-of-gravity vertical position/posture and the floor reaction force's vertical component trajectory are contin- 
uously connected to those of the nonnal gait. 

50 [0295] Specifically, based on the value (ZO", VzO") seen from the current time gait's supporting leg coordinate system 
converted from the initial body vertical position/velocity forthe normal gait finally determined in the processing of step 
S024 in Figure 1 2 (processing for determining the initial state of the normal gait), that is, the value (ZO", VzO") determined 
in step S224 in Figure 1 9 or the like, the initial total center-of-gravity position/velocity for the normal gait seen from the 
current time gait's supporting leg coordinate system is determined using the fonnula 04 (or kinematics model of the 

55 robot 1), for example. Specifically, the initial total center-of-gravrty vertical position forthe normal gait seen from the 
current time gait's supporting leg coordinate system is determined by substituting, into the fonnula 04, the body material 
particle vertical position in the model in Figure 1 0 corresponding to the body vertical position Zp" for the nonnal gait 
determined in step S224 and the leg material particle vertical positions for the supporting leg and the free leg corre- 
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spending to the values seen in the current time gait's supporting leg coordinate system converted from the foot positions 
thereof at the start of the normal gait. Besides, the initial total center-of-gravity vertical velocity for the normal gait seen 
from the current time gait's supporting leg coordinate system is determined by substituting Jnto aformula obtained by 
differentiating the both sides of the formula 04, the body material particle vertical velocity in the model in Figure 10 

5 corresponding to the body vertical velocity VzO" for the normal gait determined in step S224 and the leg material particle 
vertical velocilies for the supporting leg and the free leg corresponding to the values seen in the current time gait's 
supporting leg coordinate system converted from the foot vertical velocities thereof at the start of the normal gait. The 
calculation of the initial total center-of-gravity vertical position/velocity may be performed using a more precise model. 
[0296] Then, the initial total center-of-gravity vertical position/velocity for the normal gait thus determined is substi- 

10 tuted for the final total center-of-gravity vertical position/velocity in the formula 13 and the following formula 41 , and 
the last-time desired gait Instantaneous values (more specifically, values in the current time supporting leg coordinate 
system converted from the final states of the last time desired gait) of the total center-of-gravity vertical position and 
velocity are substituted for the initial total center-of-gravity vertical position and velocity in the formulas 13 and 41 , 
thereby determining the floor reaction force's vertical component pattern (more specifically, parameter values) for the 

15 current time gait so that the formulas 13 and 41 are satisfied. Here, the integral values in the formulas 13 and 41 are 
the integral values for the period from the start to the end of the current time gait. 

final total center-of-gravity vertical velocity - initial 

20 

total center-of-gravity vertical velocity 
= first order integral of (floor reaction force's vertical 
25 component/mass of the robot) 

+ first order integral of the gravitational acceleration formula 41 

[0297] Here, the gravitational acceleration is a negative value. 
30 [0298] More specifically, first, assuming that at least two parameters of the floor reaction force's vertical component 
parameters (times of apexes or the like) that define the floor reaction force's vertical component pattern as shown in 
Figure 6 are unknown variables, the value of the unknown variables are determined by solving the simultaneous equa- 
tions comprising the formulas 13 and 41 . 

[0299] As the floor reaction force's vertical component parameters assumed to be unknown variables, the height 
35 (peak value of the floor reaction force's vertical component) and the width (duration of the one leg supporting period) 
of the trapezoid in Figure 6 may be adopted. In this case, the gradients of the sides of the trapezoid in Figure 6 are 
set to values predetermined in accordance with the period of the current time gait or the like, or the times of the apexes 
of the floor reaction force's vertical component pattern excluding the time of shifting from the one leg supporting period 
to the floating period occurs are set to values predetermined in accordance with the period of the current time gait or 
40 the like. Incidentally, if there is only one unknown variable, in general, there is no solution that satisfies the formulas 
13 and 41. 

[0300] Then, the process proceeds to step S608, where the floor reaction force's horizontal component allowable 
range [Fxmin, Fxmax] (specifically, parameters for defining the pattern of the floor reaction force's horizontal component 
allowable range) is detemnined in the same manner as the first and second turning gaits of the normal gait. For example. 

45 the floor reaction force's horizontal component allowable range having a pattern shown in Figure 33 is set. In this 
embodiment, the floor reaction force's horizontal component allowable range is set based on the fomiula 12 in accord- 
ance with the floor reaction force's vertical component pattern previously determined in step S606. 
[0301] Then, the process proceeds to step S610, where the ZMP trajectory for the current time gait (specifically, 
parameters defining the ZMP trajectory, such as times or positions of the apexes of the trajectory) is set as shown in 

50 Figure 7 to have a high stability margin and not to change abruptly, as with the first and second turning gaits of the 
normal gait. The parameters are set in such a manner that the ZMP trajectory for the current time gait is seamlessly 
connected to the ZMP trajectory for the normal gait. That is, the ZMP trajectory parameters are determined in such a 
manner that the position of the ZMP at the end of the current time gait agrees with the ZMP position at the start of the 
normal gait. In this case, for the running gait, the times or positions of the apexes of the ZMP trajectory in the one leg 

55 supporting period may be set in the same manner as the ZMP trajectory parameters for the normal gait described 
above. And, the ZMP trajectory parameters are set in such a manner that the desired ZMP trajectory in the floating 
period linearly continuously change from the start of the floating period to the ZMP position at the start of the normal gait. 
[0302] Here, the ZMP trajectory parameters for the current time gait determined in step S61 0 are provisional ones 
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and to be corrected as described later. Thus, the ZMP trajectory for the current tinne gait thus set is referred to as a 
provisional desired ZMP trajectory for the current time gait hereinafter. 

[0303] Finally, the process proceeds to step S612, where a body posture angle restoring pehod [Ta, TbJ is set. The 
body posture angle restoring start time Ta corresponds to the time Tm in the second turning gait of the normal gait, 
5 and the body posture angle restoring end time Tb corresponds to the time Ts2 In the second turning gait of the normal 
gail These times Ta and Tb are set in Ihe same manner as the times Tm and Ts2, respectively. 

[0304] Returning to Figure 12, after the processing of step S026 (processing of determining the gait parameters for 
the current time gait) is periomied as described above, the process proceeds to step S028, vi/here the gait parameters 
for the current time gait (ZMP trajectory parameters) are corrected. In this processing, the ZMP trajectory parameters 
10 are corrected to make the body position/posture trajectory continuous with the normal gait or bring the same close to 
the normal gait. 

[0305] Figure 34 is a subroutine flowchart showing the processing. 

[0306] First, the process proceeds to step S702 via step S700, where based on the provisional desired ZMP pattern 
and the other current time gait parameters, a provisional current time gait to the end time of the current time gait is 

15 provisionally generated. 

[0307] In step S702, a process described below is conducted in accordance with the flowchart shown in Figure 35. 
[0308] In step S800, various initiaii/ations are performed. Specifically, 0 is substituted for the provisional gait gen- 
eration time l<. In addition, values in the current time supporting leg coordinate system converted from the final states 
of the last time desired gait (more specifically, final values of the gait states including the body horizontal position/ 

20 velocity, the body vertical position/velocity, the body posture angle and the angular velocity, and the desired foot position/ 
posture and the arm desired posture) are used as the current time gait's initial states. 

[0309] Then, in step S804 after step S802. it is determined whether the provisional gait generation time k precedes 
the end time Tcurr of the current time gait or not (whether k < Tcurr). If the result of the determination is YES, the 
process proceeds to a current time gait instantaneous value determination subroutine of step S806, where instanta- 
25 neous values for the current gait at the time k are determined. Then, the process proceeds to step SB08, where the 
provisional gait generation time k is incremented by Ak, and then, the process returns to step S804. 
[0310] If the result of the determination in step S804 is NO, the process shown in the flowchart in Figure 35 is 
completed. 

[0311] By the process described above, the provisional current gait is generated from the start to the end thereof. 
30 [0312] In the gait instantaneous value detemnination subroutine in step S806, the process shown In Figure 36 Is 

performed. This process will be described below. 

[031 3] First, in step S900, based on the floor reaction force's vertical component trajectory parameters of the current 
time gait parameters, the value (current time value) of the desired floor reaction force's vertical component at the time 
k shown in Figure 6 is determined. Then, in step S902, based on the ZMP trajectory parameters of the current time 
35 gait parameters, the value (current lime value) of the desired ZMP trajectory (provisional desired ZMP trajectory) at 
the time k shown in Figure 7 is determined. 

[031 4] Then , the process proceeds to step S904. where based on the current time gait parameters (the foot trajectory 
parameters, the reference body posture trajectory parameters and the arm posture trajectory parameters), the values 
(current time values) of the desired feet positions/postures, the reference body posture and the desired arm posture 

40 at the time k are detemnined. However, as for the desired amn posture, while the total arm center- of- gravity position Is 
determined, the degree of freedom of the movement that involves a change of angular momentum about the vertical 
axis (or the body trunk axis) is not determined yet. As in the normal gait, the desired foot position/posture trajectory 
and the floor reaction force's vertical component trajectory for the current time gait are independently determined in 
accordance with the foot trajectory parameters and the floor reaction force's vertical component trajectory parameters 

45 determined in the flowchart in Figure 32, respectively 

[0315] Then, the process proceeds to step S906, where the total center-of-gravity vertical position at the time k that 
provides the current time value of the desired floor reaction force's vertical component determined in step S900 (i.e., 
brings the sum of the vertical inertial force of the robot 1 and gravity into balance with the desired floor reaction force's 
vertical component) is calculated. Specifically, this calculation is performed in the same manner as the processing in 

50 step S406 in Figure 21 . 

[0316] Then, the process proceeds to step S908, where the current time value of the body vertical position that 
provides the total center-of-gravity vertical position thus determined is calculated. Specifically, this calculation is per- 
formed in the same manner as the processing in step S408 in Figure 21 . 

[0317] Then, the process proceeds to step S91 0, where based on the parameters of the floor reaction force's hori- 
55 zontal component allowable range determined in step 8608 in Figure 32, the value (current time value) of the floor 
reaction force's horizontal component allowable range [Fxmin, Fxmax] at the time k shown in Figure 33 is determined. 
[0318] Then, the process proceeds to step 8912, where the body horizontal acceleration and the body posture an- 
gular acceleration for the current time provisional gait are determined so as to satisfy the desired ZMP (that is, the 
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horizontal component of the moment about the desired ZMP is 0). However, these acceleration are determined in such 
a manner that the floor reaction force's horizontal component Fx doesn't exceed the range [Fxmin, Fxmax], This process 
is slightly different from the process shown in the flowchart in Figure 22, which illustrates the processing in step S41 2 
in Figure 21 In detail. 

5 [0319] Specifically, in step S912, the process shown in Figure 37 is performed. In the flowchart shown in Figure 37, 
first in step S1000, it is determined whether or not the lime k lies within the body posture angle restoring period [Ta, 
Tb] determined in step S612 in Figure 32. 

[0320] If the result of the determination is NO (the floor reaction force's horizontal component allowable range Is 0 
or narrow), the processings from step S1002 to step S1 01 4 are performed. The processings from step S1002 to step 
10 SI 01 4 are the same as the processings from step S504to step 851 6 in Figure 22 described above^ and thus, description 

thereof is omitted. 

[0321] if the result of the determination In step SI 000 is YES, the process proceeds to step 81016, where the body 
posture restoring moment ZMP-converted value pattern ZMPrec is set. In this case, unlike step S518 in Figure 22 
concerning the normal gait generation, ZMPrec is set to a pattern of a constant value of 0 (that is, the height of the 

15 trapezoidal pattern shown in Figure 26 is 0). Then, the processings from step SI 01 8 to step S1026 are performed. 
The processings from step 81 01 8 to step SI 026 are the same as the processings from step 8520 to step S528 in 
Figure 22 described above, and thus, description thereof Is omitted. In the processings from step 81 01 6 to step 81 026, 
the instantaneous value of the body posture restoring moment ZMP-converted value ZMPrec is always 0, and therefore, 
the body posture angular acceleration p for the body rotation mode determined in step S1020 is also 0. Therefore, 

20 assuming that P = 0. only the processings in steps 81022, 81024 and S1026 may be performed. If the result of the 
determination in step 81000 is YES, that is. during the body posture angle restoring period [Ta, Tb], P is 0 0 = 0) as 
described above. Therefore, in step 891 2, in the body posture angle restoring period [Ta, Tb] (that is, a period in which 
the floor reaction force's horizontal component allowable range is wide enough), a movement trajectory for body postu re 
change In the direction for restoring the body posture angular velocity is not generated, unlike the case of normal gait 

25 generation. 

[0322] In this embodiment, since the reference body posture is the vertical posture, and the body posture angular 
acceleration depending on the reference body posture is 0, the angular acceleration p for the body rotation mode 
determined as described above is regarded as the body posture angular acceleration determined in the processing in 
step 891 2. However, If the reference body posture trajectory parameters are set in such a manner that the reference 
30 body posture varies, the sum of the angular acceleration |5 for the body rotation mode determined as described above 
and the reference body posture angular acceleration should be regarded as the body posture angular acceleration 
determined in the processing of step 8912. 

[0323] Once the processing In step S912 in Figure 36 is completed as described above, the process proceeds to 
step 891 4, where the body horizontal velocity is determined by Integrating the body horizontal acceleration determined 

35 in step 891 2 (cumulatively summing the body horizontal acceleration values from the start of the current time gait (time 
k = 0) to the present time k) , and the body horizontal position (current time value) is determined by Integrating the body 
horizontal velocity (cumulatively summing the body horizontal velocity values from the start of the current time gait 
(time k = 0) to the present time k). In addition, the body posture angular velocity is determined by integrating the body 
posture angular acceleration determined in step 8912 (cumulatively summing the body posture angular acceleration 

40 values from the start of the current time gait (time k = 0) to the present time k), and the current time value of the body 
posture angle is determined by integrating the body posture angular velocity (cumulatively summing the body posture 
angular velocity values from the start of the current time gait (time k^ 0) to the present time k). The processing in step 
891 4 is the same as the processing in step 8414 in Figure 21 . 

[0324] After the current time gait instantaneous value determination subroutine of step 8806 in Figure 35 is conducted 
45 as described above, the process proceeds to step 8808, where the value of the gait generation time k is incremented 
by the gait generation interval Ak. Then, the process returns to step 8804, and as far as the condition shown in step 
8804 is satisfied, the processings of steps 8806 and 8808 are repeated. Then, If the condition shown In step SB04 is 
not satisfied, that is, if the provisional current time gait is generated to the end thereof, the process proceeds to step 
S704 in Figure 34. 

50 [0325] 1 n step S704, from the body horizontal position/velocity (Xe, Vxe) at the end of the current time gait determined 
in step 8702 as described above, the final divergence component q0[k] (k = Tcurr) is determined using the formula 
shown in the drawing (fomnula 1 0). 

[0326] Then, the process proceeds to step 8706, where a final divergence component error errq, which is the differ- 
ence between the current time gait's final divergence component q0[k] and the nonnal gait's Initial divergence compo- 
55 nent q" (determined in step S224 in Figure 1 9), is determined using the formula shown in the drawing. Then, the process 
proceeds to step 708, where it is determined whether the final divergence component error errq thus determined falls 
within an allowable range (a range in the vicinity of 0) or not. 

[0327] If the result of the determination in step S7Q8 is NO, the process proceeds to step 871 0, where, assuming 
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that a = Aa (Aa is a predetermined small amount), based on a desired ZMP obtained by correcting the current provisional 
desired ZMP pattern to be trapezoidal in accordance with the relationship shown in Figure 38, the provisional current 
time gait to the end thereof is calculated in the same manner as in step S702. Here, with reference to Figure 38, "a" 
denotes the height of the trapezoidal pattern for correcting the provisional desired ZMP to make the current time gait's 

5 final divergence component agree with the normal gait's Initial divergence component as closely as possible (bring the 
body horizontal position/poslure trajectory for the current time gail close to the body horizontal position/posture trajec- 
tory for the normal gail). In this case, in Ihis embodiment, the correction of the provisional desired ZMP is performed 
during a period in which substantially the whole surface of the sole of the supporting leg's foot 22 (whole sole contact 
period), that is, during a period in which the floor reaction force's horizontal component allowable range is sufficiently 

^0 wide, and the times of the apexes of the trapezoidal pattern are set to the times of the apexes of the provisional desired 
ZMP pattern in the whole sole contact period. The assumption that a ^ Aa in stop S710 is intended for observing a 
change of the final divergence component error errq occurring when the current provisional desired ZMP trajectory is 
corrected by a small amount using the trapezoidal pattern, 

[0328] After the provisional current time gait obtained when the provisional desired ZMP trajectory is corrected on 
15 the assumption that a = Aa is generated to the end thereof in step S710, the process proceeds to step S712, where 
based on the body horizontal position/velocity (Xel Vxe1) at the end of the provisional current time gait, the final 
divergence component q1 [k] for the provisional current time gait is determined using the formula shown in the drawing 
(formula 10). 

[0329] In this embodiment. Aa is assumed to be an appropriately set small constant in step S71 0. However. Aa may 
20 be set to decrease as the final divergence component error errq decreases through repeated calculations described 
below. However if Aa is a constant, the final divergence component error errq can be made to fall within the allowable 
range by several repeated calculations. 

[0330] Then, the process proceeds to step S714, where a parameter sensitivity r (rate of change of the final diver- 
gence component error with respect to Aa) is detemnined using the fomiula shown in the drawing. Then, the process 
25 proceeds to step S71 6, where a correction quantity in a trapezoidal pattern having a height of a ( = -errq/r, which is a 
value obtained by dividing the final divergence component error errq determined in step S706 by the parameter sen- 
sitivity r determined in step S714) is added to the provisional desired ZMP pattern in accordance with the relationship 
shown in Figure 38, thereby correcting the provisional desired ZMP pattern (determining a new provisional desired 
ZMP pattern). 

30 [0331] Then, the process returns to step S702. Then, as far as the result of the detemnination in step S708 is NO, 
the processings from steps S702 to S71 6 are repeated, and if the result of the detemnination in step S708 is YES, the 
repetition loop (step S700) is exited, and the process proceeds to step S718. 

[0332] In step S71 8, based on the difference between the final body posture angle for the provisional current time 
gait and the initial body posture angle for the normal gait, the difference between the final body posture angular velocity 

35 for the current time gait and the initial body posture angular velocity for the normal gait or the like, a pattern of the body 
posture restoring moment ZMP-converted value (ZMPrec) for the current time gait is determined in such a manner that 
the body posture angle for the current time gait is brought close to the body posture angle for the normal gait. ZMPrec 
determined in this step is used for correcting the provisional desired ZMP to maintain the agreement between the 
current time gait's final divergence component and the normal gait's initial divergence component (condition in step 

40 S708) even if a body posture angular acceleration is produced so as to connect the body posture angle trajectory to 
the normal gait (bring the body posture angle trajectory close to the normal gait) during a period in which the floor 
reaction force's horizontal component allowable range is sufficiently wide (a period in the one leg supporting period) 
in the processing of generating the current time gait instantaneous values described later 

[0333] ZMPrec has a trapezoidal pattern as with that described concerning the nonnal gait generation process and, 
45 specifically, is determined in the following manner. That is, assuming that, in the trapezoidal pattern of ZMPrec shown 
in Figure 26, the times of the apexes (folds) of the trapezoid are known (specifically, the times of the apexes of the 
trapezoid are adjusted to the times of apexes of the desired ZMP) and the height of the trapezoid is unknown, the 
height (parameter) of trapezoid of ZMPrec is determined as described below. However, concerning step S718, the 
times Tm and Ts2 in Figure 26 are replaced with the times Ta and Tb, respectively. 
50 [0334] If the body posture restoring moment ZMP-converted pattern has only one unknown parameter as described 
above, in general, both of the body posture angle and the body posture angular velocity of the current time gait cannot 
be seamlessly connected to those of the normal gait at the end of the current time gait. Thus, in this embodiment, the 
unknown parameter is determined in such a manner that the state of the generated gait is gradually brought close to 
the state of the normal gait through plural steps. 
55 [0335] Incidentally, both of the body posture angle and the body posture angular velocity of the current time gait may 
be connected to those of the normal gait at the end of the current time gait under the conditions that the ZMPrec pattern 
for one gait is more complicated and two or more unknown parameters are used. However, in such a case, there is a 
possibility that the ZMPrec pattem varies too largely In a zigzag. 
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[0336] In the following, a calculation principle will be described, and then, a calculation procedure will be described. 
[0337] The difference between the final body posture angle for the provisional current tinne gait determined as de- 
scribed above on the assumption that the height of the trapezoidal ZMPrec pattern is 0 in step S702 and the initial 
body posture angle for the normal gait, and the difference is denoted by Bern In addition, the difference between the 
5 final body posture angular velocity for the provisional current time gait and the Initial body posture angular velocity for 
the normal gait is determined, and the difference is denoted by vOerr. 

[0338] Here, it is assumed that the current time gait is generated on the assumption that the height of the trapezoidal 
ZMPrec pattern is a certain value bcurr, and subsequently, the first turning gait is generated by the same algorithm as 
the current time gait. Here, it is assumed that the pattern of the body posture restoring moment ZMP-converted value 

10 ZMPrec for the first turning gait is expressed by a sum of the ZMPrec pattern for the first turning gait determined in 
stop S51 8 in Figure 22 (trapezoidal pattern having a height of acyd shown in Figure 26) and a certain value b1 . 
[0339] The gait thus generated is referred to as a ZMPrec-corrected gait, and the final body posture angle and the 
final angular velocity (at the end of the first turning gait) are denoted by G1 and vei , respectively. 
[0340] The body posture angle and the angular velocity at the end of the first turning gait of the original normal gait 

15 determined when the subroutine for determining the initial states of the normal gait in step S024 are denoted by G1 org 
and vGlorg, respectively (the original normal gait is one determined on the assumption that the initial body posture 
angle and the initial angular velocity for the normal gait determined by the formulas 30 and 31 in step S310 are used 
as initial values, and the pattern detennined In step S518 (trapezoidal pattern having a height of acyd in Figure 26) 
is used as the ZMPrec pattern), 

20 [0341] Here, AGI and AvGI are defined as follows. 

Aei = ei - eiorg formula so 



Avei ^ vei - vGlorg formula 51 

[0342] Aei and AvGI represent differences In body posture angle and angular velocity, respectively, between the 
ZMPrec-corrected gait and the original normal gait at the time when the first turning gait is generated to the end thereof. 
30 If Aei and AvGI are 0. when the second turning gait is generated subsequently to the ZMPrec-corrected gait by the 
same algorithm as the current time gait on the assumption that the height of the trapezoidal ZMPrec pattern Is acyc2, 
the generated gait agrees with the original normal gait. 

[0343] Therefore, a current time gait's trapezoidal pattern height bcurr and a first turning gait's trapezoidal pattern 
height b1 are detennined so that AGI and AvG1 are 0, and the determined value bcurr is used finally as the trapezoidal 

35 pattern height for the current time gait. 

[0344] Since the dynamics model concerning the body posture angle of the robot 1 has a linearity similar to that of 
the flywheel FH as shown in Figure 10, AGI and AvG are related as follows with the current time gait's trapezoidal 
pattern height bcurr, the first turning gait's trapezoidal pattern height b1, the dtfference Gerr between the final body 
posture angle for the provisional current time gait and the initial body posture angle forthe normal gait, and the difference 

40 vGerr between the final body posture angle for the provisional current time gait and the initial body posture angular 
velocity for the normal gait. 

AGI -c11 * bcurr -fc12* b1 + Gerr + el * vGerr formula 52 

45 

AVGI = c21 * bcurr + c22 * b1 + e2 * vGerr formula 53 

Here, c11 , c12, c21 , c22, el and e2 are coefficients that are uniquely detennined by the gait periods of the current 
50 time gait and the first turning gait, parameters of the pattern of thebodyposturerestoringmoment ZMP-convertedvalue 
ZMPrec (in particular, parameters concerning time), or the like. 

[0345] Based on the principle described above, in the calculation procedure, the body posture angle difference Gerr 
and the angular velocity difference VGerr at the boundary between the provisional current time gait and the normal gait 
are first determined. 

55 [0346] Then, the coefficients c11 , c12, c21 , c22, e1 and e2 of the formulas 52 and 53 are determined based on the 
gait periods of the current time gait and the first turning gait, parameters of the pattern of the body posture restoring 
moment ZMP-converted value ZMPrec (in particular, parameters concerning time), or the like. 
[0347] Then, the current time gait's trapezoidal pattern height bcun' and the first turning gait's trapezoidal pattern 
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height b1 are determined in such a nnanner that the right sides of the formulas 52 and 53 are 0. That is, the simultaneous 
equations of the formulas 52 and 53 with the right sides being 0 are solved to determined the values bcurr and b1 . 
[0348] Finally, the height of the trapezoidal pattern of the body posture restoring moment ZMP-converted value (ZM- 
Prec) for the current time gait is set to the determined current time gait's trapezoidal pattern height bcurr. 

5 [0349] Then, the process proceeds to step S720, where as a desired ZMP pattern for the current time gait, a pattern 
is determined which is a sum of the current provisional desired ZMP pattern (provisional desired ZMP pattern when 
the repetition loop in step S700 is exiled) and the body posture restoring moment ZMP-converted value pattern deter- 
mined as described above in step S718. This processing is the same as the processing of adding the trapezoidal 
pattern having a height of Aa to the provisional desired ZMP pattern in step S710. 

10 [0350] A reason why the body posture restoring moment ZMP-converted value pattern is added to the provisional 
desired ZMP pattern will bo described below. 

[0351] The provisional current time gait gcneratod in the loop in step S700 is generated on the assumption that the 

body posture restoring moment ZMP-converted value ZMPrec is 0 (the height parameter of the trapezoidal ZMPrec 
pattern is 0) as described above. For the provisional current time gait thus finally generated in the loop in step S700, 
15 while the body position/velocity is continuous to or close to that for the normal gait, the body posture angle is shifted 
from the body posture angle for the normal gait or possibly diverges. 

[0352] The body posture restoring moment ZMP-converted value pattern determined in step S718 is one that pro- 
duces such a body posture angular acceleration that brings the shift of the body posture angle from that for the nomnal 

gait close to 0. 

20 [0353] However, if the body posture angular acceleration according to the body posture restohng moment ZMP- 
converted value pattern determined in step S718 is produced without correcting the provisional desired ZMP pattern 
resulting from the loop in step S700, the body horizontal position trajectory has to be shifted from the body horizontal 
position trajectory for the provisional current time gait in order to satisfy the dynamical equilibrium condition (that the 
moments applied to the desired ZMP by the resultant force of gravity and the inertial force of the robot, except for the 

25 vertical moment, are 0). Thus, in this embodiment, the provisional desired ZMP pattern is corrected so that there is no 
need to shift the body horizontal position trajectory from that resulting from the loop in step S700 
[0354] If. besides the movement according to the provisional current time gait, the body posture angular acceleration 
according to the body posture restoring moment ZMP-converted value pattern determined in step S718 is produced, 
the ZMP (a point where the moments caused by gravity and the inertial force caused by a movement, except for the 

30 vertical moment, are 0) is shifted by the body posture restoring moment ZMP-converted value. Therefore, if a pattern 
which is a sum of the provisional desired ZMP pattern and the body posture restoring moment ZMP-converted pattern 
is used as a desired ZMP pattern, and a current time gait that satisfies the desired ZMP pattern is generated while 
producing a body posture angular acceleration for the body rotation mode associated with the body posture restoring 
moment ZM P-converted value pattern detenmined in step S71 8, a body translation movement similar to the provisional 

55 current time gait is provided. 

[0355] Above described is a reason why the sum of the body posture restoring moment ZMP-converted value pattern 
and the provisional desired ZMP pattern is used as the desired ZMP pattern. 

[0356] Returning to Figure 12, after correcting the current time gait parameters In step S028 as described above, or 
it the result of the determination in S016 is NO, the process proceeds to step S030, where current time gait's instan- 

^o taneous values are determined. 

[0357] In step S030. the same processings as those in steps S900 to S910 in Figure 36 are perfonned, and then, 
the processings in steps SI 000 to S1026 in Figure 37, which is the subroutine of step S912, are performed. In this 
case, however, in step S1016 in Figure 37, the body posture restoring moment ZMP-converted value (ZMPrec) pattern 
is not set to 0 but to be the body posture restoring moment ZMP-converted value (ZMPrec) pattern set in step S718 

45 in Figure 34. Then, the same processing as that in step S914 in Figure 36 is perfonned, and the process in step S030 
in Figure 12 is completed. 

[0358] Then, the process proceeds to step S032, where an anrt movement that cancels the spinning force (that 
allows the floor reaction force's vertical moment caused about the desired ZMP by movements of parts, other than the 
arms, of the robot 1 to be substantially 0) is determined. Specifically, the floor reaction force moment's vertical com- 

50 ponent trajectory in the desired ZMP in the case where the arms don't swing is detemiined. (More strictly, values 
obtained by inverting the signs of the instantaneous values of the vertical component trajectory of the moment applied 
to the desired ZMP by the resultant force of gravity and the inertial force of the robot In the case where the gait is 
generated without the amis swinging are determined.) That is, an instantaneous value is determined for the floor 
reaction force moment vertical component about the desired ZMP (instantaneous value) in balance with the instanta- 

55 neous value of the movement according to the gait generated in the processing in step S030 (excluding the arm swing 
movement). Then, the instantaneous value is divided by the equivalent moment of inertia the amn swing movement, 
thereby determining the angular acceleration of the ami swing movement required for canceling the spinning force. 
Incidentally, a too wide arm swing can be addressed by dividing the instantaneous value by a value larger than the 
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equivalent moment of inertia. 

[0359] Then, the angular acceleration is integrated two times, the resulting value is passed through a low cut filter 
for preventing the integral value from being too large, and the resulting angle is regarded as an arm swing movement 
angle. However in the arm swing movement, the left and right arms are swung oppositely in the back-and-forth direction 
5 to prevent the center of gravity of the arms from varying. An arm swing movement for canceling the spinning force may 
be generated for the normal gail, and the arm swing movement for the current lime gail be determined so as to connect 
Lo the arm swing movemenl. 

[0360] Then, the process proceeds to step S034, where the gait generation time t is incremented by At. Then, the 
process returns to step S014, and the gait generation continues as described above. 

10 [0361] Described above is the desired gait generation process conducted in the gait generation device 100. 

[0362] The operation of the device according to this embodiment will be further described with reference to Figure 
4. The gait generation device 100 generates the desired gait as described above. The desired body position/posture 
(trajectory) and the desired arm posture (trajectory) of the generated desired gait are transmitted to a robot geometrical 
model (inverse l<inematics calculator) 102, 

15 [0363] Besides, the desired foot position/posture(trajectory), the desired 2MP trajectory (that is, the desired total 
floor reaction force central point trajectory) and the desired total floor reaction force (trajectories) (specifically, the 
desired floor reaction force's vertical component and the desired floor reaction force's vertical component) are trans- 
mitted to a composite-compliance operation determinator 104 and to a desired floor reaction force distributor 106. 
Then, the desired floor reaction force distributor 106 distributes the floor reaction force among the feet 22R and 22L 

20 and determines the desired each-foot floor reaction force central point and the desired each-foot floor reaction force. 
The desired each-foot floor reaction force central point and the desired each-foot floor reaction force thus determined 
are transmitted to the composite-compliance operation determinator 1 04. The composite-compliance operation deter- 
minator 1 04 is equivalent to the compliance control means in the control device according to the present invention. 
[0364] The composite-compliance operation determinator 104 transmits a corrected desired foot position/posture 

25 (trajectory) with deformation compensation to the robot geometrical model 1 02. Upon receiving the desired body po- 
sition/posture (trajectory) and the corrected desired foot position/posture (trajectory) with deformation compensation, 
the robot geometrical model 102 calculates joint displacement commands (values) for the twelve joint (such as ICR 
(L)) of the legs 2,2 and transmits the commands to a displacement controller 108. The displacement controller 108 
controls the twelve joints of the robot 1 by following the joint displacement commands (values) calculated by the robot 

30 geometrical model 102 as desired values. Besides, the robot geometrical model 102 calculates displacement com- 
mands (values) for the arm joints that satisfy the desired am posture and transmits the commands to the displacement 
controller 1 08. The displacement controller 1 08 controls the twelve joints of the arms of the robot 1 by following the 
Joint displacement commands (values) calculated by the robot geometrical model 102 as desired values. 
[0365] The floor reaction force (specifically, actual each-foot floor reaction force) produced in the robot 1 Is detected 

35 by the six-axis force sensor 34. The detection value is transmitted to the composite-compliance operation determinator 
104. In addition, the posture inclination deviations eerrx and Oerry produced in the robot 1 are detected by the inclination 
sensor 36, and the detection values are transmitted to a posture stabilizing control calculator 112 (specifically, the 
deviation of the actual posture angle with respect to the desired body posture angle in the roll direction (about the X 
axis) is denoted by eerrx, and the deviation of the actual posture angle with respect to the desired body posture angle 

40 in the pitch direction (about the Y axis) is denoted by Oerry). Then, the posture stabilizing control calculator 112 calcu- 
lates the compensating total floor reaction force's moment about the desired total floor reaction force central point 
(desired 2MP) for restoring the body posture angle of the robot 1 to the desired body posture angle and transmits the 
calculation result to the composite-compliance operation determinator 104. Based on the input value, the composite- 
compliance operation determinator 1 04 corrects the desired floor reaction force. Specifically, the desired floor reaction 

45 force is corrected so that the compensating total floor reaction force's moment is applied about the desired total floor 
reaction force central point (desired ZMP). 

[0366] The composite-compliance operation determinator 1 04 determines the corrected desired foot position/posture 
(trajecton/) with deformation compensation in order for the states and floor reaction force of the actual robot calculated 
from the sensor detection values or the like to agree with the corrected desired floor reaction force. However, it is 

50 actually impossible that all the states agree with their respective desired values, and therefore, various trade-offs are 
made among these states so that each of them agrees with its desired value as closely as possible. That is. a control 
deviation for each desired value Is weighted, and the weighted average of the control deviation (or the square of the 
control deviation) is controlled to be minimum. Thus, the actual foot position/posture and the actual total floor reaction 
force are controlled so as to generally agree with the desired foot position/posture and the desired total floor reaction 

55 force, respectively. 

[0367] Since the present invention essentially concerns the gait generation for the robot 1 using the gait generation 
device 1 00, and the configuration and operation of the composite-compliance operation detenrilnator 1 04 or the tike 
are described in detail In Japanese Patent Laid-Open No. 10-277969 previously filled by the applicants or the like, 
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further details thereof will not be described herein. 

[0368] In step S028. the current time gait is corrected In such a manner that the final divergence component of the 

current time gait agrees with a value q", which is the norma! gait's initial divergence component q[OJ seen from the 
current time gait's supporting leg coordinate system, as descnbed above. 
5 [0369] Actually, the divergence component serves as an indicator for evaluating whetherthe body horizontal position 
for a current time gait converges to that for a normal turning gait when the current lime gait is generated using a 
dynamics model in accordance with current Lime gait parameters, and successively, the normal turning gait is generated 
in accordance with normal turning gait parameters, Essentially, the divergence component has to be defined so that 
the final divergence component of the current time gait agrees with a value q", which is the normal gait's initial diver- 
ge gence component q[0] seen from the current time gait's supporting leg coordinate system when the convergence de- 
scribed above occurs. 

[0370] Actually, the divergence component defined by the formula 1 0 approximately satisfies this condition. 
[0371] Therefore, it can be said that, in this embodiment, the current time gait parameters are corrected so that the 
body horizontal position for the current time gait converges to (comes close to) that for the normal turning gait when 
15 the current time gait is generated using a dynamics model in accordance with the current time gait parameters, and 
successively, the normal turning gait is generated in accordance with nomnal turning gait parameters. 
[0372] The same Is descnbed in Japanese Patent Application No. 2000-352011 . 

[0373] In this embodiment of the current time gait parameters, the desired ZMP pattern is particularly corrected to 
satisfy the condition (that the current time gait comes close to the nonnal gait). Referring to Figure 39, a trajectory 
20 denoted by symbol B indicates a body horizontal position trajectory generated in such a manner that the divergence 
components of two gaits agree with each other at the boundary of the gaits as described above. 
[0374] A trajectory denoted by symbol A indicates a body horizontal position trajectory resulting from generating a 
current time gait in such a manner that the body horizontal position/velocity agrees with that for the normal turning gait 
at the boundary therebetween and then generating normal gaits repeatedly 
25 [0375] As shown in this drawing, the trajectory B generally doesn't agree with the trajectory A at the boundary between 
the current time gait and the first normal turning gait. Then, however, the trajectory B gradually converges to (comes 
close to) the trajectory A and substantially agrees with the trajectory A in the next nonnal turning gait cycle. As described 
above, as with the gait generation method involving agreements about both the position and velocity at the gait bound- 
ary, the gait generation method involving only agreement about the divergence component at the gait boundary can 
30 prevent a gait from diverging. A trajectory denoted by symbol C indicates a trajectory generated without consideration 
for these conditions. In this case, the generated trajectory diverges with time. Of course, both the agreements about 
both the position and velocity may be achieved by using more complicated desired ZMP pattern and adjusting a plurality 
of parameters. However, in such a case, there Is a possibility that a zigzag desired ZMP pattern results. Since agree- 
ments about both the position and velocity result in agreement about the divergence component, it can be said that 
the method involving agreements about both the position and velocity is a special example of the method involving 
agreement about the divergence component. 

[0376] Furthermore, it can be said that, in this embodiment, the current time gait parameters are corrected so that 
the body posture angle for the current time gait converges to (comes close to) or agree with the body posture angle 
for the normal turning gait when the current time gait is generated using a dynamics model in accordance with the 
current time gait parameters, and successively, the nomnal turning gait is generated in accordance with norma! turning 
gait parameters. 

[0377] Since the gait generation device for the legged mobile robot according to this embodiment is configured as 
described above, strictly, the curved relationship shown by the solid line in Figure 41 is a relationship between the final 
body horizontal position and final body horizontal velocity for the current time gait which satisfies the condition that the 
body horizontal position for the current time gait converges to that for the nonnal turning gait when the cun-ent time 
gait is generated using a dynamics model in accordance with the current time gait parameters, and successively the 
normal turning gait is generated in accordance with normal turning gait parameters. According to the essential definition 
of the divergence component, the value of the divergence component has to be constant for any combination of the 
final body horizontal position and the final body horizontal velocity which satisfies the relationship represented by the 
solid line in Figure 41 In addition, for making the divergence component a physically comprehensive Indicator, it is 
desirable that the final body horizontal position and the divergence component have the same value when the'flnal 
body horizontal velocity is 0. 

[0378] That is, it is desirable that the relationship shown by the solid line in Figure 41 is represented by the following 
formula 60, and the following formula 61 is satisfied, where f denotes a function for detennining the divergence com- 
55 ponent. 



35 



40 



45 



50 



f (final body horizontal position, final body horizontal 
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velocity) ^ C 

(C denotes a constant) formula 60 



f (final body horizontal position, 0) = final body horizontal 

position formula 61 

[0379] The value of the function f (final body horizontal position, final body horizontal velocity) is the value of the 
divergence component. 

[0380] The above-described formula 1 0, which defines the divergence component, is an approximate expression of 
the function f. In the case where the divergence component defined by the formula 10 is a constant, the final body 
horizontal position and the final body horizontal velocity are related to each other as shown by the dotted line in Figure 
41 , which is an approximate line of the solid line. 

[0381] The function f representing the divergence component may be approximated to a curve using a polynomial, 
rather than to a straight line. Alternatively, the function f may be converted into a map for storage. 
[0382] For a higher approximation precision, the function f should be varied with the normal gait parameters. 
[0383] In the fonnula 10 defining the divergence component, the body position and velocity may be replaced with 
the robot total center-of-gravity position and velocity, respectively. 

[0384] I n this embodiment, to be readily understood, it Is assumed that the floor reaction force's horizontal component 
allowable range can be set separately for the back-and-forth direction (X-axis direction) and the sideward direction (Y- 
axis direction). However, if the floor reaction force's horizontal component allowable range is represented by relational 
formulas for the back-and-forth direction and the sideward direction, a gait that avoids slipping can be generated. 
[0385] For example, the allowable range may be a so-called friction circle as described by the following formula. 

(X component of floor reaction force's horizontal component) 

* (X component of floor reaction force's horizontal component) 
+ (Y component of floor reaction force's horizontal component) 

* (Y component of floor reaction force's horizontal component) 

< (ka * H * Fz) * (ka * H * Fz) formula 59 

[0386] Here, Fz denotes the desired floor reaction force's vertical component, denotes a friction coefficient, and 
ka denotes a positive constant equal to or smaller than 1 . 

[0387] However in the case where the floor reaction force's horizontal component allowable range is represented 
by the relational formulas for the back-and-forth direction and the sideward direction as described above, the movement 
on the sagittal plane and the movement on the lateral plane have to be detemnined simultaneously or alternately so 
as to satisfy the allowable ranges for the directions simultaneously or alternately. 

[0388] Since the sum of the total center-of-gravity vertical acceleration and the gravitational acceleration of the robot 
is proportional to the floor reaction force's vertical component, a parameter prescribing the total center-of-gravity vertical 
acceleration trajectory of the robot may be explicitly set as a gait parameter instead of the floor reaction force's vertical 
component trajectory. The two are substantially the same. Furthermore, a parameter prescribing the vertical acceler- 
ation trajectory of a part whose behavior resembles that of the total center-of-gravity trajectory of the robot may be set 
explicitly. For example, in the case where the mass of the legs is sufficiently smaller than the mass of the body, the 
body vertical acceleration trajectory and the total center-of-gravity vertical acceleration trajectory of robot are substan- 
tially the same or proportional to each other Therefore, the body vertical acceleration trajectory may be used instead 
of the floor reaction force's vertical component trajectory. Similarly, since floor reaction force's horizontal component 
and the total center-of-gravity horizontal acceleration of the robot are proportional to each other, the total center-of- 
gravity horizontal acceleration of the robot and the allowable range thereof may be used instead of the floor reaction 
force's horizontal component and the allowable range thereof in this embodiment. Furthermore, a parameter concerning 
the horizontal acceleration trajectory of a part whose behavior resembles that of the total center-of-gravity horizontal 
trajectory of the robot may be set explicitly. For example, in the case where the mass of the legs is sufficiently smaller 
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than the mass of the body, the body horizontal acceleration trajectory and the total center-of-gravity horizontal accel- 
eration trajectory of the robot are substantially the sanne or proportional to each other. Therefore, the body horizontal 
acceleration and the allowable range thereof may be used instead of the floor reaction force's horizontal component 
and the allowable range thereof. 

5 [0389] In order for the floor reaction force's horizontal component and the floor reaction force's moment about the 
desired ZMP to have adequate values, two movement modes, thai is, the body rotation mode and the body translation 
mode are used In the embodimenls described above. However another movement mode may be used. 
[0390] For example, as shown in Figure 40, if the body posture is rotated about the hip joint, the total center of gravity, 
as well as the angularmomentum about the total center of gravity, varies. Combining (synthesizing) this movement 

fo with the movement in the body translation mode by a predetermined ratio results in substantially the same movement 
in the body rotation mode, and no floor reaction force's horizontal component occurs. Therefore, if this mode is regarded 
as the body rotation mode, a gait similar to those in the embodiments described above can be generated according 
to the algorithm in this embodiment. 

[0391] Therefore, there is no need to have at least one movement mode that produces no floor reaction force's 
15 horizontal component. This is because any floor reaction force's horizontal component and floor reaction force's mo- 
ment about the desired ZMP can be produced for any combination of movement modes as in the example described 
above, as far as the two movement modes produce the floor reaction force's horizontal component and the floor reaction 
force's moment about the desired ZMP in different ratios. 

[0392] Alternatively, a movement mode other than those involving varying the body posture may be used. However 
^0 it is preferable that a movement mode is chosen in which a minimum displacement produces a large floor reaction 
force's horizontal component or floor reaction force's moment about the desired ZMR 

[0393] For example, a movement mode in which the left and right arms are swung in the same rotational direction, 
or a movement mode in which the position of a foot not in contact with the floor (floating in the air) is brought into 
perturbation may be used. However, in the case where the free leg trajectory is brought into perturbation, the amount 
25 of perturt^ation should be reduced to approximately 0 by the time immediately before landing to avoid varying the 
landing position. 

[0394] Alternatively, three or more movement modes may be used. 

[0395] In this case, at least two of the chosen movement modes have to be ones that produce the floor reaction 
force's horizontal component and the floor reaction force's moment about the desired ZMP In different ratios. Otherwise, 
30 in general, the simultaneous equations would have no solutions (the behavior for each movement mode cannot be 
determined uniquely). 

[0396] Furthemnore, preferably, a movement mode that varies the floor reaction force's moment about the desired 
ZMP significantly and doesn't vary so largely the floor reaction force's horizontal component is combined with a move- 
ment mode that varies the floor reaction force's horizontal component significantly and doesn't vary so largely the floor 

35 reaction force's moment about the desired ZMP. 

[0397] In other words, preferably, a movement mode that varies the angular momentum adequately and doesn't vary 
so largely the total center of gravity is combined with a movement mode that varies the total center of gravity adequately 
and doesn' t vary so largely the angular momentum. This Is because such combination allows the displacements of 
the movement modes to be reduced. 

40 [0398] Models other than the dynamics models used in the embodiments, such as those described below, may be 
used. 

1 ) A nonlinear model in which material particles are provided for a plurality of links as shown in Figure 11 (multi- 
mass model). 

45 2) A three-material-pariticle model disclosed in Japanese Patent Application No. 2000-352011 filed by the appli- 

cants. 

3) A one-material-particle model in which only the body has a mass. 

4) A model which neglects the moment of the inertial force caused by an angular momentum variation about the 

total center of gravity. 

50 5) A separate-type model which has a partial model representing a relationship between the resultant force of 

gravity and the inertial force (or the floor reaction force in balance therewith) and the body translation movement 
and a partial model representing a relationship between the resultant force and the body rotation movement. For 
example, the material particles shown in Figure 1 0 constitute the partial model representing a relationship between 
the resultant force and the body translation movement, and the flywheel shown in Figure 1 0 constitutes the partial 

55 model representing a relationship between the resultant force and the body rotation movement. 

[0399] In addition, the processings may be performed using only one model, or different models may be used for 
the different processings. For example, since the normal gait is generated only to determine the final state of the current 
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time gait, the required dynamics precision of the normal gait is lower than that of the current time gait. Therefore, for 
example, while the dynamics model (model consisting of three material particles and a flywheel) shown in Figure 10 
is used in generation of the current time gait, in generation of the normal gait (in particular, steps S408 and S412 in 
Figure 21 a dynamics model which consists of the body material particle 24m corresponding to the body 24 and the 

5 flywheel FH, neglecting the masses of the legs 2, 2 (that is, a model consisting of one material particle and a flywheel, 
which results from eliminating the teg material particles 2m, 2m from the model in Figure 1 0) may be used. In generation 
of the normal gait in this case, in the embodiments described above, the processings in steps S408 and S412 in Figure 
21 are performed assuming that the mass of the leg material particles 2m, 2m is 0. This allows calculation amount 
involved in the normal gait generation to be significantly reduced. 

10 [0400] In the embodiments described above, the block diagrams, the flowcharts and the algorithms may be altered 
into equivalent ones by changing the sequence of calculations. In addition, a low-pass filter may be inserted appropri- 
ately. 

[0401] While the embodiments of the present invention has been described concerning a two-legged mobile robot, 
the present invention can be applied to a legged robot having three or more legs. 

15 [0402] Here, the process of determining the initial (time Ts) body vertical position Zs in step S206 in Figure 19 will 
be described supplementally. According to the process of determining the body height proposed by the applicants in 
Japanese Patent Laid-Open No. 10-86080, the body vertical position is determined in such a manner that the bending 
angle of the knees of the legs satisfies a certain relationship. However, as for the body vertical position at the time 0 
(that is. at the instant of landing), it may be determined in such a manner that the bending angle of the knee of the leg 

20 just landing is a predetermined angle or falls within a predetermined angle range. This is because the capacity to 
absorb the impact of landing primarily depends on the bending angle of the knee of the landing leg. Incidentally, if the 
bending angle of the knee Is close to 0 (that is, the leg is almost fully stretched), the capacity to absorb the impact of 
landing tends to be reduced. On the other hand, an excessive knee bending may results in an excessive torque of the 
knee joint actuator. 

25 [0403] Furthermore, in this embodiment, in step S206 in Figure 19, the body vertical position at the instant of landing 
is determined in a kinematical (geometrical) manner, and the body vertical position at any time except for the instant 
of landing is determined based on the desired vertical floor reaction force so as to satisfy the dynamical condition. 
However, more generally, the body vertical position at the time when the leg is stretched to a maximum extent (in other 
words, the knee bending angle becomes closest to 0, or the distance between the hip joint and the ankle joint is the 

30 largest), such as immediately before and after landing or taking off the floor, may be determine in a kinematical (geo- 
metrical) manner, and the body vertical position at any other time may be determined based on the desired vertical 
ffoor reaction force so as to satisfy the dynamical condition. 

[0404] Instead of determining the initial states of the normal gait (including, primarily, initial body horizontal position/ 
velocity and initial body vertical position/velocity) using a searching approach or using partially an analytic approach 
35 as in this embodiment, the initial states of the normal gait may be previously calculated for various normal gait param- 
eters using these approaches, a relationship between the normal gait parameters and the initial states of the normal 
gait may be stored in the form of a map or approximate expression, and the initial values for the nonnal gait may be 
determined based on the map or approximate expression when the robot actually moves. 

[0405] Furthermore, a function resulting from combination of the relationship represented in a map or approximate 
40 expression and the function f may be stored in the form of a map or approximate expression. That Is, a function that 
determines the divergence component of the normal gait directly from the normal gait parameters comprising the foot 
trajectory parameters, the floor reaction force vertical trajectory parameters and the like may be stored In the form of 

a map or approximate expression. For example, a normal gait is previously generated for each of sets of a plurality of 
representative normal gait parameters, initial states of the normal gait for each set of normal gait parameters (which 

45 are determined in step S024 in Figure 1 2) are determined, and a map representing a relationship between the normal 
gait parameters of each set and the initial states of the normal gait is created. Then, when generating a desired gait, 
the initial states of the normal gait may be determined from the set of normal gait parameters which are selected from 
the map or determined by interpolating the map. This eliminates the need of generating a normal gait each time a 
current time gait is generated and allows calculation amount involved in the desired gait generation to be significantly 

50 reduced. 

[0406] In this embodiment, the desired ZMP parameter of the current time gait Is corrected to correct the current 
time gait to connect the current time gait to the normal gait (or to bring the current time gait close to the normal gait). 
However, another parameter may be corrected. 

[0407] For example, the trajectory of the floating free leg of the current time gait may be modified. In addition, for 
55 example, if the body horizontal position is to be displaced reanward from that of the normal gait, the free leg Is moved 
forward quickly after taking off the floor to shift the free leg's center of gravity forward. This causes the body horizontal 
position that satisfies the desired ZMP to move forward acceleratedly. As a result, the body hohzontal position is further 
moved fonward at the end of the current time gait and thus is made to agree with that of the nomnal gait. 
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[0408] Alternatively, instead of correcting the desired ZMP parameter, the period of the current time gait may be 
corrected. For example, if the body horizontal position is to be displaced rearward from that of the normal gait, the 
period of the current time gait may be elongated. This is because, if the period of the current time gait is elongated, 
the duration of the movement of the body horizontal position is also elongated, and the body horizontal position can 
move forward further proportionately. 

[0409] If the desired ZMP parameter is corrected when determining an appropriate value of the body horizontal 
position or the like In a searching manner, the body horizontal posilion at the end of the current time gait varies In 
approximate proportion to the correction of the desired ZMP. Thus, the approphate value can be determined with a 
reduced number of searches. On the other hand, if the free leg's center of gravity or the period of the gait is corrected, 
the body horizontal position at the end of the current time gait varies significantly nonlinearly with respect to the cor- 
rection. Thus, the determination of the appropriate value requires more searches. 
[0410] In this embodiment, the desired ZMP parameter of the current time gait Is corrected to correct the current 
time gait to connect the current time gait to the normal gait (or to bring the current time gait close to the norma! gait). 
According to this method, the correction amount of the desired ZMP parameter (correction amount a in Figure 38) may 
f5 probably be excessive. For example, in the case where a request to move at a high velocity starting from a gait of 
hopping at one spot (that Is, a running request) Is given, the desired ZMP parameter has to be significantly displaced 
rearward in the direction of travel In order to connect the hopping gait to the high-velocity normal gait (running normal 
gait) (or bring the hopping gait close to the high-velocity nonnal gait). In this case, a gait parameter other than the 
desired ZMP parameter is also preferably corrected as described above. However, In this case, the request for such 
20 rapid acceleration is in itself unreasonable, and therefore, the required value may be corrected. 

[0411] When correcting the required value, for example, the normal gait that satisfied the request (that is, required 
parameters) is determined according to the procedure described with reference to this embodiment, and the current 
time gait parameters are detennined so as to connect the current time gait to the normal gait. Then, it is determined 
whether the stability margin of the desired ZMP trajectory of the current time gait is too small or not. If the stability 
margin is to small (that is, the desired ZMP lies outside the supporting polygon or near the edge of the supporting 
polygon), the request may be corrected. 

[0412] Altematively, an allowable range of the acceleration/deceleration ((initial velocity of the next time gait - initial 
velocity of the current time gait)/ (period of the current time gait)) of the gait may be previously set. In this case, when 
a request (that is, a required parameter concerning the gait period) is received, the acceleration/deceleration suitable 
for the request is determined, and if the detennined acceleration/deceleration exceeds the allowable range, the request 
is corrected to make the acceleration/deceleration to fall within the allowable range. 

[0413] If the floor reaction force vertical component parameter for making the body vertical position/velocity at the 
end of the current time gait agree with the body vertical position/velocity at the start of the normal gait exceeds the 
capacity of the robot, the floor reaction force vertical component parameter may be determined in such a manner that 
agreement about at least the body vertical position, rather than both the posilion and velocity, is achieved. 
[0414] Alternatively, the floor reaction force vertical component parameter may be determined in such a manner that 
the body vertical position at the end of the current time gait is lower than the body vertical position at the start of the 
normal gait and the body vertical velocity at the end of the current time gait has a larger magnitude in the upward 
direction than the body vertical velocity at the start of the normal gait. 

[0415] Altematively, the weighted averages of the body vertical position and body vertical velocity at the end of the 
current time gait may be detennined using a predetermined weight, and the floor reaction force vertical component 
parameter may be determined in such a manner that the determined weighted averages agree with the weighted 
averages of the body vertical position and body vertical velocity at the start of the normal gait. 

[0416] Alternatively, the floor reaction force vertical component parameter may be detennined in such a manner that 
the sum of the potential energy and kinetic energy of the robot at the end of the current time gait agree with that at the 
start of the nonnal gait. 

[0417] Alternatively, the process of determining the pattern of the body posture restoring moment ZMP-converted 
value (ZMPrec) in such a manner that the body posture angle of the current time gait comes close to the body posture 
angle of the normal gait performed in step S718 in Figure 34 may be used. That is, the floor reaction force vertical 
50 component parameter may be determined using the process of step S71 8 or another process of determining the body 
posture restohng moment ZMP-converted value (ZMPrec) described later with the body posture angle and the body 
posture restoring moment ZMP-converted value being replaced with the body vertical position and the floor reaction 
force vertical component, respectively. 

[0418] The floor reaction force horizontal component allowable range [Fxmin, Fxmax] may be set so as to satisfy 
55 the following fomutas 62 and 63. 
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Fxmax - kmax-^-Fz + kc.(XG - ZMPx)/(ZG - ZMPz).Fz 
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Fxmln ~ kmin-.u.Fz + kc.(XG - ZMPx)/(ZG - ZMPz)-Fz 

(kmax > 0, kmin < 0) formula 62 

5 

However the upper limit Fxmax is set not to be larger than the value of Fxmax determined by the formula 12 on the 
assumption that Ka = 1 , and the lower limit Fxmin is set not to be smaller than the value of Fxmin determined by the 

formula 12 on the assumption that Ka = 1 . 

[0419] Here, "ZMPx" denotes the horizontal position of the desired ZMP, and "ZMPz" denotes the vertical position 
10 of the desired ZMP 

[0420] In addition, it is assumed that "XG" and "ZG" denote the horizontal position and vertical position, respectively, 
of a material particle which produces an approximate resultant force of the gravities and inertial forces applied on a 
group of material particles including at least the body material particle. In other words, (XG, ZG) indicates the position 
of a material particle which is representative of a group of material particles including at least the body material particle. 
15 For example, (XG, 2G) is the total center of gravity or the center of gravity of the whole body excluding a part of a leg. 
Alternatively, (XG, ZG) may be the position (Xb, Xz) of the body material particle 24m in the dynamics model used in 
the above-described embodiment and shown in Figure 10. 

[0421 ] If it is assumed that kc = 0 in the formula 62, the formula 62 is the same as in the above-described embodiment 
(see the fomnula 12). 

20 [0422] If the value kc is set to 1 (kc = 1 ), and the values Fxmax and Fxmin are set to approximately 0, the vector of 
the desired floor reaction force (Fx, Fz) acting on the desired ZMP (ZMPx, ZMPz) points approximately to the position 
(XG, ZG). Thus, the variation of the direction of the desired floor reaction force (in particular, the variation with a high 
frequency) can be reduced. 

[0423] As a result, the variation of the desired floor reaction force horizontal component Fx is moderated, and thus, 

25 the foot is contact with the floor more intimately and prevented from slipping. 

[0424] Since the acceleration of the body horizontal position trajectory is proportional to the value Fx, the variation 
of the acceleration of the body horizontal position trajectory is also moderated, the variation of the body horizontal 
position at the end of the gait occurring when the desired ZMP Is corrected becomes linear, the convergence in search- 
ing for the normal gait or current time gait becomes more quick, and thus, the number of searches can be reduced. 

30 [0425] I n addition, in the case where kc = 1 and kmax = kmin = 0, the same behavior as that of a one-material-particle 
model results (in particular, if the position (XG, ZG) is the total center of gravity). In this case, the body horizontal 
position trajectory of the nonnal gait can be readily searched for 

[0426] Besides, in the formula 62. the temn (ZG - ZMPz) may be substituted with a predetermined constant. This is 
because the value (ZG - ZMPz) doesn' t vary significantly during walking or running (specifically, it varies by, at most, 
35 about 10%). 

[04271 In the case where kc = 1 , kmax := kxmin - 0, the value (ZG - ZMPz) in the formula 62 is substituted with a 
predetermined constant and the position (XG, ZG) is the total center of gravity, the same behavior as that of a linear 
inverted pendulum with one material particle results. The behavior can be solved in an analytic manner, so that the 
normal gait and the current time gait can be determined without any searching method. However, the angular accel- 

40 eration of the body rotation mode varies more largely. 

[0428] The values AMp, AFp, AMr and AFr may be determined in an analytic manner by dynamical calculation if such 
a simple dynamics model as described above is used. However, in the case where a more general and more compli- 
cated dynamics model is used, these values may be determined by detennining the floor reaction force in the case 
where the body is accelerated by a small amount in the body translation mode or in the body rotation mode, calculating 

45 the difference between this determined floor reaction force and the floor reaction force In the case where the body is 
not accelerated, and dividing this difference by the small amount. 

[0429] Alternatively, average values for AMp. AFp, AMr, AFr and AMp/AMr for a standard gait may be previously 
determined and used. In this case, since the values AMp, AFp, AMr, AFr and AMp/AMr vary with the state of the robot 
(specifically, the posture and the rate of variation thereof), the precision is slightly reduced compared to methods In 
50 which the values are detennlned for each instantaneous state. However, when a more complicated model than the 
above-described model Is used, the amount of calculation can be reduced significantly. 

[0430] In the process from step S504 to step S516 in Figure 22 and the process from step S1002 to step SI 014 in 
Figure 37, if the floor reaction force horizontal component Fx falls within the allowable range with a sufficient margin, 
this margin may be used to gradually bring the integral value of the body posture angular acceleration p, that is, the 
55 body posture angular velocity up to that point In time back to the original value (initial state). 

[0431] Specifically, in step S506 or SI 004, the value (denoted by prec) of the body posture angular acceleration (3 
for gradually bringing the integral value of the body posture angular acceleration p back to the original value is deter- 
mined from the integrated value of the body posture angular acceleration [5 up to that point in time. For example, the 
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value prec may be a value obtained by multiplying the integral value of the body posture angular acceleration p by the 
negative gain. 

Then, the value Fxtmp is determined by the following formula 70, instead of the formula 1 7. 

5 

Fxtmp = dFp * atmp - prec * AFp * AMr/AMp 

+ msup * d2Xsup/dt2 + mswg * d2Xswg/dt2 formula 70 

10 [0432] The second term in the right side of the fonnula 70 represents the floor reaction force's horizontal component 

caused by the acceleration (-prec * AMr/AMp) in the body translation mode which is required to cancel the moment 
(prec * AMr) produced about the desired ZMP when the robot moves in the body rotation mode with the body posture 
angular acceleration being prec. 

[0433] The value Fxtmp determined by the formula 70 represents the body horizontal acceleration in the body trans- 
15 lation mode which is required to satisfy the current time (time k) desired ZMP in the case where the robot moves in 
the body translation mode while moving in the body rotation mode with the body posture angular acceleration being 
prec starting from the last time instantaneous desired gait state (desired gait state at the time k-1 ). 
[0434] The following processings are the same as those in the embodiment described above. Since the margin of 
the floor reaction force horizontal component Fx can be used to restore the body posture angular velocity to some 
20 extent in the above-described process, the variation of the body posture angular velocity can be further reduced. 

[0435] If the body posture angle at the end of the provisional current time gait differs significantly from the body 
posture angle at the start of the normal gait when the ZMPrec pattern set in step S1 01 6 In Figure 37 has a constant 
value of 0, the height of the trapezoidal pattern shown in Figure 26 may be set to a value other than 0 to reduce the 
difference. In this case, however, in the subsequent step S71 8 shown in Figure 34, the body posture restoring moment 
25 ZMP-converted value pattern set in step S1 01 6 has to be added to the body posture restoring moment ZMP-converted 
value pattern detemnined in step S718. This allows the finally resulting gait to be exactly or substantially the same as 
the gait resulting when a pattern having a constant value of 0 is set in step SI 01 6. 

. [0436] However, it is preferable that, during the period from the start to the end of the process of the search loop of 
step S700 in Figure 34, the body posture restoring moment ZMP-converted value pattern set in step 81016 In Figure 
37 (specifically, the height of the ZMPrec pattern shown in Figure 26) Is not changed. If it is changed during the process, 
there is a possibility that the final divergence component errq doesn't converge, and thus, the loop cannot be exited. 
[0437] As a method of detennining the height bcurr of the trapezoid of the body posture restoring moment ZMP- 
converted value (ZMPrec) for the current time gait, the following method may be used. 

[0438] The body posture angle and angular velocity at the end of the current time gait of the ZMPrec corrected gait 
35 (see the description about step S718 in Figure 34) are denoted by Ocurr and vecurr. respectively, and the differences 
between the body posture angle and angular velocity at the end of the current time gait and the body posture angle 
and angular velocity at the start of the nomnal gait are denoted by AOcerr and AvOcerr, respectively. 
[0439] Assuming that the gait period is an interval, the differences Oerr and vGerr between the body posture angle 
and angular velocity at the end of the provisional current time gait and the body posture angle and angular velocity at 
40 the start of the nonnal gait are the last time states, the value bcuur is an Input, and the values AGcerr and AvBcerr are 
the current time states, a characteristic equation In a discrete system is established. Then, a feedback rule may be 
established using the modem control theory or the like in such a manner that the valuesAGcerr and AvOcerr converge 
to 0, and the value bcurr may be determined based on the feedback rule. 

[0440] The ZMPrec for the current time gait and/or the nonnal gait may not have a trapezoidal pattern. The ZMPrec 
45 value for each instant may be detennined using a state feedback rule or the like, based on the difference between the 
desired body posture angle and angular velocity and the reference body posture angle and angular velocity or the like, 
in such a manner that the difference converges to 0. 

[0441 J The ZMPrec for the current time gait may not have a trapezoidal pattern. The ZMPrec value for each instant 
may be determined using a state feedback rule or the like, based on the desired body posture angle and angular 
50 velocity of the current time gait, in such a manner that the body posture angle and the angular velocity come close to 
the body posture angle and angular velocity at the start of the first turning gait. 

[0442] Now, generation of a walking gait of the robot 1 will be described. The walking gait is a gait including no 
floating period in which one-leg supporting periods and two-leg supporting periods are repeated alternately. 
[0443] When generating a walking gait, the following process is conducted in steps SI 06 and 8606. Specifically, the 
floor reaction force vertical component trajectory is determined in such a manner that a characteristic quantity, such 
as phase or amplitude^ of the body vertical position trajectory (which is determined using the body height determination 
method disclosed in Japanese Patent Laid-Open No. 10-86080 by the applicants) is satisfied as fully as possible, the 
body vertical position trajectory being determined based on a geometrical condition (geometrical limitation) concerning 
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at least displacement of a joint of each leg, such as one concerning an appropriate knee bending angle. 
[0444] Thus, the algorithms for generating a walking gait and a running gait can have a common essential part, and 
shitting from the walking gait to the running gait or from the running gait to the walking gait can be conducted. 
[0445] Now, the process will be described with reference to Figure 43. First, in step SI 300, using the body height 

5 determination method previously proposed by the applicants in Japanese Patent Laid-OpenNo. 1 0-86080 or the like, 
the body verlica] position irajeclory which satisfies a predetermined geometrical limiLation concerning at least displace- 
ment of a joint of each leg 2 is determined, In the following, this is referred lo as a reference body vertical position 
trajectory. More specifically, first, based on the foot trajectory parameters, the desired ZMP trajectory parameters or 
the like determined in accordance with the required parameters, the body horizontal position trajectory is determined 

10 usingtheflrstembodimentdisclosedin Japanese Patent Application No. 2000-352011 previously filed by the applicants. 
In this case, the body horizontal position trajectory is determined in such a manner thattho floor reaction force's vertical 
component agrees with the weight of the robot 1 , and the floor reaction force's moment about the desired ZMP has a 
horizontal component of 0 assuming that the body vertical position has a predetermined constant value. In addition, 
the body posture trajectory may be a trajectory of a certain posture (vertical posture or the like). 

15 [0446] Then , using the body height determination method previously proposed by the applicants (in Japanese Patent 
Laid-Open No. 10-86080, more specifically, the method shown in Figure 6 of this document orthe tike), the body vertical 
position trajectory is calculated based on the foot trajectory determined by the foot trajectory parameters, and the body 
horizontal position trajectory and body posture trajectory thus determined, and the calculated body vertical position 
trajectory is assumed as the reference body vertical position trajectory. 

20 [0447] Then, the process proceeds to step S1302, where a characteristic quantity, such as amplitude or phase, of 
the reference body vertical position trajectory is calculated (extracted) in order to determine the floor reaction force 
vertical component trajectory which allows generation of a desired body vertical position trajectory resembling the 
reference body vertical position trajectory as closely as possible. For example, the amplitude of the reference body 
vertical position trajectory (that is, the difference between the minimum value and the maximum value thereof) is cal- 

25 culated as a characteristic quantity. 

[0448] Next, the process proceeds to step SI 304, where floor reaction force's vertical component trajectory param- 
eters (times and values of a floor reaction force's vertical component at apexes) are determined in such a manner that 
a body vertical position trajectory, which is generated on the basis of floor reaction force's vertical component trajectory 
parameters, satisfies the characteristic quantity as much as possible (in such a manner that the body vertical position 

30 trajectory has a pattern similar to the reference body vertical position trajectory as much as possible). More specifically, 
in the case of a walking gait, a first turning gait and a second turning gait of a normal gait and a floor reaction force's 
vertical component trajectory of a current time gait are set, for example, in a polygonal pattern as shown in Figure 42. 
That is, the floor reaction force's vertical component trajectory for the walking gait Is set to have a trapezoidal shape 
protruding in the direction of the floor reaction force's vertical component increasing (protruding upward) during the 

35 two-leg supporting period and set lo have a trapezoidal shape protruding in the direction of the floor reaction force's 
vertical component decreasing (protruding downward) during the one-leg supporting period. Then, floor reaction force's 
vertical component trajectory parameters, for example, heights C1 , C2 of two trapezoids of the floor reaction force's 
vertical component trajectory are determined (in this example, times of apexes of the floor reaction force's vertical 
component trajectory are determined according to required parameters relating to a gait period) in such a manner that 

40 a difference between a maximum value and a minimum value of a body vertical position trajectory corresponding to a 
total center-of-gravity vertical position trajectory of the robot 1 . which is obtained by second order integral of the floor 
reaction force's vertical component trajectory from a gait initial period (start time of the two-leg supporting period) to 
an end (end time of the one-leg supporting period), agrees with the characteristic quantity. 

[0449] However, parameters of the floor reaction force's vertical component trajectory of the normal gait are deter- 
45 mined so as to satisfy the following condition as describe above. Condition) An average value of the floor reaction 
force's vertical component trajectory in an entire period of the normal gait (periods of the first and second turning gaits) 
is made to agree with the weight of the robot. That is, an average value of the floor reaction force's vertical component 
is made equal in magnitude and opposite in direction to gravity applied to the robot. 

[0450] In addition, the parameters of the floor reaction force's vertical component trajectory of the current time gait 
50 are determined In such a manner that the body (total center-center-of-gravity) vertical position trajectory is seamlessly 

connected to or comes close to the nonnal gait, as described above. 

[0451] By the processing described above, the desired floor reaction force's vertical component trajectory (param- 
eters defining the same) in the walking gait is determined. Gait generation process otherthan the determination process 
for the desired floor reaction force's vertical component traj ectory described above may be identical with the embod- 
55 Iment related to the walking gait described above. 

[0452] A calculation amount required for determining the reference body vertical position trajectory is relatively targe 
as described above. Thus, it is also possible that a map, which represents a relationship between movement parameters 
(foot trajectory parameters, etc.) of the normal gait and characterietic quantities (amplitude, etc.) of the body (total 
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center-of-gravity) vertical position trajectory, is created and stored in advance, and a characteristic quantity is deter- 
mined from give normal gait parameters with reference to the map. 

[0453] Alternatively, it is also possible that a map, which represents a relationship between movement parameters 
of the normal gait in the case where a characteristic quantity of the body (total center-of-gravity) vertical position tra- 
5 jectory generated from the floor reaction force's vertical component substantially agrees with a characteristic quantity 

of the reference body vertical position Irajectory and floor reaction force's vertical component trajectory parameters, 
is created and stored in advance, and the floor reaction force's vertical component trajectory parameters is determined 
from give normal gait parameters with reference to the map. 

[0454] Note that, basically, the characteristic quantity only has to be a characteristic quantity that represents char- 
10 acteristics of a shape of the reference body vertical position trajectory based upon the geometrical limitation condition. 
Other than amplitude, a phase, and the like of the reference body vertical position trajectory, a frequency component 
or the like (e.g., an amplitude of a basic frequency component, etc.) may be used as the characteristic quantity 
[0455] Moreover although the characteristic quantity of the reference body vertical position trajectory for one step 
is used in the above-mentioned example, an initial state (position, velocity) of the reference body vertical position 
15 trajectory may be used as a charactenstic quantity to determine the floor reaction force's vertical component trajectory 
parameters as described below. 

[0456] That is, as shown in Figure 44, first, instep S1400, using the body height determination method proposed by 
the applicant previously (Japanese Patent Application Laid-Open No. 10-86080) or the like, a reference body vertical 
position at an initial time of a gait and a reference body vertical position after At seconds (after a control cycle) are 

20 determined on the basis' of at least the geometrical limitation conditions, and an initial reference body vertical velocity 
is calculated on the basis of a difference between the reference body vertical position at an Initial time of the gait and 
a reference body vertical position after At seconds. Note that the reference body vertical position at an initial time and 
a reference body vertical position after At seconds can be determined if, for example, the processing of step S1300 in 
Figure 43 is executed from the initial time until At seconds elapses. 

25 [0457] Subsequently, the process proceeds to step S1402, where an initial reference total center>of-gravity vertical 
velocity is calculated using a robot geometric model (e.g., a model found by differentiating both side of the formula 04) 
on the basis of a foot position trajectory detennined by the initial reference body vertical velocity and the foot trajectory 
parameters. 

[0458] Finally, the process proceeds to step S1404, where floor reaction force's vertical component trajectory pa- 
30 rameters are detennined in such a manner that an initial velocity of the total center-of-gravity vertical position trajectory 
generated from the floor reaction force's vertical component trajectory agrees with the initial reference total center-of- 
gravity velocity detennined as described above. Note that, in this case, again, the floor reaction force's vertical com- 
ponent trajectory parameters are detemnined in such a manner that not only the condition of the Initial velocity but also 
the above-described conditions related to the normal gait and the current time gait (the conditions described in relation 
-35 to the processing in Figure 43) are satisfied. 

[0459] In addition, if the processing in Figure 44 is performed in step S106 in Figure 14, since an initial body vertical 
velocity Vzs (at a time Ts) is determined at that point, naturally, the processing for determining the body vertical velocity 
Vzs can be omitted in step S206 in Figure 19. 

[0460] It is also possible that, in the case where a walking gait is generated, using the body height determination 
40 method proposed by the applicant previously (Japanese Patent Application Laid-Open No. 10-86080) or the like, a 
body vertical position is determined on the basis of at least the geometrical limitation conditions and, in the case where 
a running gait is generated, the body vertical position is detennined from the floor reaction force's vertical component 
as described in steps S906, S908 in Figure 36. In this case, it Is preferable that a final body vertical position in a gait 
at the time when the gait shifts from walking to running or from running to walking is determined by synthesizing a body 
45 vertical position Zg for walking, which is determined on the basis of the geometrical limitation condition, and a body 
vertical position Zf for running, which is determined dynamically from the floor reaction force's vertical component. 
More specifically, for example, as indicted by the following formula 71, a final body vertical position Z is determined 
according to a weighted average of those body vertical positions Zg and Zf . In this case, a weight w Is gradually changed 
from 1 to 0 or from 0 to 1 . 

[0461] Consequently, the body vertical position trajectory during the time when the gait shifts from walking to running 
can be changed smoothly. 
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body vertical position Z - (1 -w)*Zg + w*Zf formula 71 

[0462] Specific processes will be described with reference to Figure 45. First, in step SI 500, as described in the 
above embodiment (see step s908 in Figure 36), the body vertical position Zf satisfying a total center-of-gravity vertical 
position trajectory, which is determined according to a desired floor reaction force's vertical component trajectory, Is 
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calculated. Subsequently, the process proceeds to step S1502, the body vertical position Zg. which is determined on 
the basis of at least the geometrical limitation condition concerning displacement of the joints (knee joints) of the 
respective legs 2, is generated using the body height detennination method proposed by the applicant previously or 
the like. 

5 [0463] Then, the process proceeds to step S1504, where the weight w is determined according to a time of a gait. 
For example, the weight w of the formula 71 is determined so as to change gradually from 0 to 1 or from 1 to 0 from 
the start to the end of the gait. In this case, the weight w is determined In such a manner that w is changed from 0 to 
1 at the time of shift from walking to running and is changed from 1 to 0 at the time of shift from running to walking. 
Note that it is advisable to also set a variation rate of the weight w (a first order time differential of a weight) so as to 

10 change continuously. Moreover it is advisable to also set a variation rate of the variation rate of the weight w (a second 
order time differonttal of a weight) so as to change continuously. Consequently, a body vertical position trajectory to 
be finally generated becomes smooth. 

[0464] Finally, the process proceeds to step S1506, where a final body vertical position is detemriined according to 
the formula 71 . 

15 [0465] Note that the weight w may take an intermediate value between 0 and 1 not only at the time when a gait shifts 
from walking to running or from running to walking but also at other times. In addition, the shift from walking to running 
or from running to walking is not required to be perfonned in one gait but may be performed in plural gaits. 
[0466] In gait generation at the time of movement on a slope (when the robot 1 is moved on an inclined f loor surface), 
instead of the allowable range of the floor reaction force's horizontal component and the allowable range of the total 

20 center-of-gravity acceleration's horizontal component, the allowable range of a floor-surface-parallel component (com- 
ponent parallel to the floor surface) of the translation floor reaction force, that is, the allowable range of the friction 
force, or the allowable range of a component parallel to the floor surface of the total center- of- gravity acceleration 
(which is proportional to the friction force) may be set. For example, as for a case of setting the allowable range of the 
floor-surface-parallel component of the translation floor reaction force (friction force) (the same holds true for a case 

25 of setting the allowable range of the floor-surface-parallel component of the total center-of-gravity acceleration), as- 
suming that the inclination angle of the floor surface with respect to the horizontal surface Is denoted by 0f (where Gf 
is positive when the surface is inclined downwardly in the travel direction of the robot 1 ), the friction force is represented 
by the following formula 72. Thus, in the case where a gait is generated according to the same algorithm as that in the 
embodiments described above, it is advisable to convert the friction force allowable range into the floor reaction force's 

30 horizontal component allowable range using the formula 72 to thereby set the floor reaction force's horizontal compo- 
nent allowable range. Note that, in this case, as thefloor reaction force's vertical component in a formula 72, the desired 
floor reaction force's vertical component only has to be used. 

2^ friction force = floor reaction force's horizontal component 

* cos (6f) - floor reaction force's vertical component * sin 

(Gf) formula 72 

40 

[0467] Determination of parameters of the current time gait may be performed again in the processing of generating 
the current time gait as described in Japanese Patent Application No. 2000-352011 filed by the applicant other than 
being performed at the point when the last time gait is completed as in the above-described embodiments. This is 
because this process increases the amount of calculation but, when there is a change in a request for a gait, can 

45 instantaneously cope with the change. 

[0468] In addition, it is also possible that, in the case where the current time control cycle is not enough for correction 
of a gait (which means current time gait parameters are detemiined again) , a gait not corrected or provisionally corrected 
(a gait that is in the course of search and does not satisfy a search completion condition (deviation from gait boundary 
requirements falls within an allowable value) completely) is outputted for the time being, and the gait is changed to an 

50 appropriate corrected gait (not provisional) by the next time control cycle or by the completion of plural control cycles. 
Since the corrected desired ZMP and desired floor reaction force's vertical component trajectory are continuous, and 
these never change suddenly after a short time, there is almost no problem except that only the desired ZMP trajectory 
and the desired floor reaction force's vertical component trajectory are zigzagged slightly. 

[0469] Instead of the arm swing movement that cancels the spinning force in step S032 in Figure 12, a movement 
55 for rotating (twisting) the body 24 about a trunk axis (or a vertical axis) thereof may be perfonned. Alternatively, the 
arm swing movement and the movement for rotating (twisting) the body 24 about the trunk axis (or the vertical axis) 
thereof may be combined. 

[0470] When the body vertical position satisfying the total center-of-gravity vertical position velocity is determined in 
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step S408 in Figure 21 and step S908 in Figure 36, instead of detemnining the body vertical position in an analytical 
manner using the formula 04 or the like as described above, the body vertical position may be determined according 
to another method 1 or 2 described below. 

5 Another method 1 : 

[04711 Figure 46 shows a calculation process flowchart of another method 1 . 

[0472] First, in step S1100, a total center-of-gravity vertical position/velocity is calculated using the dynamics model 
on the basis of a last time instantaneous desired gait state (the desired gait state determined at the time l<-1) or the 
like. The total center-of-gravity vertical position/velocity calculated using the dynamics model is hereinafter referred to 
as a model total ccnter-or-gravity vertical position/velocity. That is, in step S1100, the last time model total center-of- 
gravity vortical position/velocity is calculated. Note that, as the dynamics model, for example, a multi-mass model or 
the like as shown in Figure 11 only has to be used, 

[0473] Subsequently, the process proceeds to step S1102, where a difference between the last time model total 
15 center-of-gravity vertical position/velocity determined as described above and the total center-of-gravity vertical posi- 
tion/velocity calculated in step S406 in Figure 21 or step S906 in Figure 36, that is, the total center-of-gravity vertical 
position/velocity satisfying the current time value (value at the time k) of the desired floor reaction force's vertical 
component (both a difference of a position and a difference of a velocity; this difference will be hereinafter referred to 
as a center-of-gravity vertical position/velocity deviation) is determined. That is, the center-of-gravity position/velocity 
20 deviation is determined according to the following formula 80. 

center-of-gravity vertical position and velocity deviation 
25 = last time model total center-of-gravity vertical position 

and velocity 

- total center-of-gravity direction position and velocity 

30 

satisfying the desired floor reaction force's vertical 

component formula 80 

35 [0474] Subsequently, the process proceeds to step S1 104, where a current time body vertical position (a current 
time value of the body vertical position) is detennined on the basis of at least the center-of-gravity vertical direction 
deviation and the last time body vertical position (the body vertical position determined at the time k-1) in such a manner 
that the model total center-of-gravity vertical position/velocity follows the total center-of-gravity vertical position/velocity 
satisfying the desired floor reaction force's vertical component. For example, the current time body vertical position is 

40 determined according to the following formula. 

current time body vertical position 
= last time body vertical position 
+ Kgz * center-of-gravity vertical position deviation 

+ Kgvz * center-of-gravily vertical velocity deviation formula 81 

50 

Here, "Kgz" and "Kgvz" denote gains. 

[0475] Kgvz may be 0. In this case, it is unnecessary to calculate a total center-of-gravity vertical velocity and a 
center-of-gravity vertical direction velocity deviation that satisfy the model total center-of-gravity vertical velocity and 
the desired floor reaction force's vertical component. 
55 [0476] The current time body vertical position is calculated as described above. In this case, when the formula 81 is 
used, the current time vertical position is calculated according to the center-of-gravity vertical position deviation and 
the center-of-gravity vertical velocity deviation. 

[0477] In addition, it is also possible that, in order to determined the current time body vertical position, the current 
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time body vertical position is determined by adding a component (feed-forward component) corresponding to the body 
vertical position determined using the model of the robot 1 (e.g., a three-material-particle model obtained by excluding 
the flywheel FH from the model of Figure 10) to the last time body vertical position other than the component corre- 
sponding to the center-of-gravity vertical position deviation and the component corresponding to the center-of-gravlty 

5 vertical velocity deviation In this case, a provisional body vertical position (which is referred to as an FF body vertical 
position here) is determined using, for example, the three-malerial-particle model from the total cenler-of-gravity vertical 
position velocity calculated in step S406 in Figure 21 or step S906 in Figure 36, thai is, the total cenler-of-gravily vertical 
position velocity satisfying the current time value (the value at the time k) of the desired floor reaction force's vertical 
component and the current time value (the value at the time k) of the desired feet positions/postures calculated in step 

10 S404 in Figure 21 or step S904 in Figure 36. Note that, in the case the body vertical position is detennined using the 
model of Figure 10 in step S408 in Figure 21 or stop S908 in Figure 36 as described above, the body vertical position 
only has to be used directly as the FF body vertical position. Then, with a value, which obtained by multiplying the FF 
body vertical position determined as described above with an appropriate gain, is further added to the right side of the 
formula 81 as a feed-forward component, whereby the current time bodyvertical position is detennined. That is, the 

15 current time body vertical position is determined by correcting the last time body vertical position according to the 
center-of-gravity vertical position deviation and the center-of-gravity vertical velocity deviation (the center-of-gravity 
vertical velocity deviation may be omitted) and the FF body vertical position. This allows fluctuation of the current time 
body vertical position, which is determined finally, to be controlled. Note that it is preferable that the model of the robot 
1. which is used for detepnining the last time body vertical position with this method, is a more precise model. 

20 

Another method 2: 

[0478] In addition, the current time body vertical position may be determined according to another method 2 using 
a repetitious searching method as described below. 

25 [0479] Figure 47 shows a calculation process flowchart of the method. 

[0480] First, in step S1200, a body vertical position/velocity (more precisely, a candidate of a current time value of 
th& body vertical position/velocity) is determined provisionally. For example, a body vertical position/velocity (last time 
value) of a last time desired gait instantaneous value is detennined provisionally as a candidate value of the body 
vertical position/velocity. Alternatively, a value, which is found by adding a product of the body vertical velocity of the 

30 last time desired gait instantaneous value and a control cycle At to the last time value of the body vertical position, may 
be determined provisionally as the candidate value of the body vertical position. 

[0481] Subsequently, through step S1202, the process proceeds to step SI 204, where a current time model total 

center-of-gravity vertical position/velocity is calculated from the present value (present provisionally determined value) 
of the body vertical position velocity (candidate), the current time value of the desired feet positions/postures determined 

35 as described above, the desired body posture at the time (k-Ak) (or current time value of the reference body posture 
determined as described above), the current time value of the desired arm posture detennined as described above, 
the body honzontal position at the time (k-Ak), and a posture state of the robot 1 determined from change rates of 
these values. Note that the last time value is used for a part of variables used in the calculation of the current time 
mode total center-of-gravity vertical position/velocity. 

40 [0482] Subsequently, the process proceeds to step SI 206, where a center-of-gravity vertical direction position/ve- 
locity deviation is calculated according to the following formula 82. 

center-of-gravity vertical position and velocity deviation 

45 

~ current time model total center-of-gravity vertical position 
and velocity 

- total center-of-gravily vertical position satisfying the 

desired floor reaction force's vertical component formula 82 

[0483] Subsequently, the process proceeds to step SI 208, where, if the center-of-gravity vertical position deviation 
55 determined according to the formula 82 is within a predetemnined allowable range, the finally determined body vertical 
position (present value) is detennined as the current time value of the body vertical position (current time body vertical 
position), and the processing for detemnining the current time body vertical position Is completed. In addition, if the 
center-of-gravity vertical position deviation is not within the predetermined allowable range in the judgment of step 
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S1208, the process proceeds to step S1210. where a next candidate of the body vertical position is determined ac- 
cording to the following formula. 

^ next candidate of body vertical position 

= body vertical position 
+ Kgz * center-of-gravity vertical position deviation 

10 

+ Kgvz * center-of-gravity vertical velocity deviation fornnula 83 

Subsequently, the process proceeds to step S1212, where the next candidate of the body vertical position is set as 
the body vertical position again (the candidate of the body vertical position is updated). Then, the process proceeds 

15 to step S1204 again. Then, a current time model total center-of-gravity vertical position/velocity is determined on the 
basis of the new candidate of the body vertical position. Thereafter the above-described process is repeated until the 
center-of-gravity vertical direction position/velocity deviation falls within the predetermined allowable range. 
[0484] These methods 1 and 2 determine the body vertical position such that the model total center-of-gravity vertical 
position follows or substantially agrees with the total center-of-gravity vertical position calculated in step S406 in Figure 

20 21 or in step S908 in Figure 36, that is, a total center-of-gravity vertical position that is obtained by second order 
integration of a value found by dividing the current time value of the desired floor reaction force's vertical component 
by a total mass. 

[0485] Instead of the above, it is also possible that a body vertical velocity is determined according to the same 
method as the method 1 or the method 2 in such a manner that the model total center-of-gravity vertical velocity follows 
25 or substantially agrees with a total center-of-gravity vertical velocity that is obtained by first order integration of a value 
found by dividing the current time value of the desired floor reaction force's vertical component by a total mass, a body 
vertical velocity is detemnined by first order integration of the body vertical velocity. 

[0486] Alternatively, it is also possible that a body vertical acceleration is determined according to the same method 
as the method 1 or the method 2 in such a manner that a model total center-of-gravity vertical acceleration follows or 
30 substantially agrees with a value that Is found by dividing the current time value of the desired floor reaction force's 
vertical component by a total mass, the body vertical position is determined by second order Integration of the body 
vertical acceleration. 

[0487] However although an instantaneous dynamic error is small compared with the methods 1 and 2, even if the 
model total center-of-gravity vertical position is deviated from the total center-of-gravity vertical position, which is ob- 
35 tained by second order integration of the value found by dividing the current time value of the desired floor reaction 
force's vertical component by the total mass, due to an integration error, since an action for making the deviation to 
converge to 0 does not work, a dynamic accuracy of a gait tends to fall in a long term. 

[0488] In other words, in the methods 1 and 2, since an instantaneous dynamic error is slightly large but a long-term 
dynamic error is small, stability of a posture of a robot is improved. 

40 

Industrial Applicability 

[0489] As described above, the present invention is effective in generating a gait with which a legged mobile robot, 
such as a two-legged mobile robot, can move smoothly in a variety of gait modes. 

45 

Claims 

1. A gait generation device for generating a desired gait for a legged mobile robot that moves by operating a plurality 
50 of legs extending from a body, comprising: 

desired vertical component trajectory determining means tor determining a desired trajectory of a vertical 
component of a translation floor reaction force applied to said robot, a vertical component of a total center-of- 
gravity acceleration of the robot or a vertical component of a body acceleration of the. robot; and 
desired vertical position determining means for detemnlning a desired vertical position of the total center-of- 
gravity or body of said robot in such a manner that the vertical component of the translation floor reaction 
force, the vertical component of the total center-of-gravity acceleration or the vertical component of the body 
acceleration agrees with the desired trajectory set by the desired vertical component trajectory determining 
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means. 

The gait generation device for a legged mobile robot according to claim 1 , wherein the desired trajectory determined 
by said desired vertical component trajectory determining means is a substantially continuous trajectory. 

The gail generation device for a legged mobile robot according to claim 1 , wherein the desired trajectory determined 
by said desired vertical trajectory determining means Js a desired trajectory of said vertical component of Ihe 
translation floor reaction force or said vertical component of the total center-of-gravity acceleration, and the gait 
generation device comprises means for determining a desired position/posture of at least an end portion of each 
leg moving with said desired gait independently of the desired trajectory determined by said desired vertical com- 
ponent trajectory determining means. 

The gait generation device for a legged mobile robot according to claim 1 , wherein said desired gait is a gait which 
alternately repeats a landing period, when at least one leg of the robot is in contact with the ground, and a floating 
period, when all the legs float in the air and said desired vertical component trajectory determining means deter- 
mines the desired trajectory in such a manner that said vertical component of the translation floor reaction force 
for said desired trajectory varies in a convex pattern within the positive value region during said landing period and 
Is kept at 0 during said floating period. 

The gait generation device for a legged mobile robot according to claim 4, wherein said desired vertical position 
determining means determines the desired vertical position of the total center-of-gravity or body of the robot during 
at least one of periods close to the start time and end time of said floating period based on a geometrical condition 
concerning displacement of a joint of each leg. 

The gait generation device for a legged mobile robot according to claim 1 , wherein, after determining a provisional 

desired vertical position trajectory of the total center-of-gravlty o? body of the robot based on a geometrical condition 
concerning displacement of a joint of each leg, said desirea vertical component trajectory determining means 
comprises: 

means for determining a characteristic quantity of a variation pattern of the provisiorral desired vertical position 

trajectory; and 

means for determining the desired trajectory of the vertical component of the translation floor reaction force, 
the vertical component of the total center-of-gravity acceleration or the vertical. component of the body accel- 
eration In such a manner that the characteristic quantity of the variation pattern of the total center-of-gravity 
vertical position trajectory or body vertical position trajectory of the robot corresponding to said desired trajec- 
tory substantially agrees with the determined characteristic quantity. 

The gait generation device for a legged mobile robot according to claim 1, comprising: 

a gait generating means for generating a normal gait which is a virtual cyclic gait following a current time gait 
which is a desired gait for a predetermined period by using normal gait parameters, in generating the current 
time gait to be newly generated, the desired gait being generated by separately generating gaits for predeter- 
mined periods, the normal gait parameters being set in accordance with required parameters of the current 
time gait and including a parameterwhich defines a normal gait's desired trajectory of the vertical component 
of the translation floor reaction force applied to said robot, the vertical component of the total center-of-gravity 
acceleration of the robot or the vertical component of the body acceleration of the robot, and 

wherein said desired vertical component trajectory determining means determines said desired trajectory in 
such a manner that the vertical position trajectory of the total center-of-gravity or body of the robot moving with 
said current time gait is continuous with or close to the vertical position trajectory of the total center-of-gravity or 
body of the robot moving with the normal gait generated by said nonnal gait generating means. 

The gait generation device for a legged mobile robot according to claim 1 , wherein said desired gait Is generated 
by separately generating gaits for predetermined periods, correlation data is previously created for a plurality of 
kinds of normal gait parameters, the correlation data representing a relationship between a normal gait initial state 
and the normal gait parameters, the normal gait initial state including an initial value of the vertical position of the 
total center-of-gravity or body of the robot moving with a nonnal gait which is a virtual cyclic gait following a current 
time gait which Is a desired gaitfor a predetermined period to be newly generated, and the normal gait parameters 
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including a parameter whicfn defines a normal gait's desired trajectory of the vertical component of the translation 

floor reaction force applied to said robot, the vertical component of the total center-of- gravity acceleration of the 

robot or the vertical component of the body acceleration of the robot, 

the gait generation device further comprises normal gait's initial state determining means that, when gener- 
5 atlng said current time gait, determines^ based on said correlation data, said normal gait's initial state concerning 

the normal gait following the current lime gait from the normal gait parameters set in accordance with required 

parameters of Lhe current lime gall, and 

said desired vertical component trajectory determining means determines said desired trajectory using the 

normal gait's initial state determined by said normal gait's initial state determining means in such a manner that 
10 the vertical position trajectory of the total center-of-gravity or body of the robot moving with said current time gait 

is continuous with o r close to the vertical position trajectory of the total conter-of-gravity or body of the robot moving 

with said normal gait. 

9. The gait generation device for a legged mobile robot according to claim 7 or 8, wherein said legged mobile robot 
15 is a two-legged mobile robot with two legs, and said required parameters include a parameter that defines landing 

positions/postures for two steps of an end portion of a leg of the two-legged mobile robot and a parameter that 
defines gait periods for first and second steps. 

10. The gait generation device for a legged mobile robot according to claim 7 or 8, wherein at least the normal gait 
20 parameter that defines a desired position/posture trajectory of an end portion of each leg for said normal gait is 

determined independently of said normal gait's desired trajectory. 

11 . The gait generation device for a legged mobile robot according to claim 7 or 8, wherein said normal gait's desired 
trajectory is a trajectory defined so that the average value of said vertical component of the translation floor reaction 

25 force for the normal gait's desired trajectory for a period of one cycle of said nonnal gait agrees with the weight of 

the robot. 

12. The gait generation device for a legged mobile robot according to claim 7 or 8, wherein said current time gait and 
normal gait are gaits which alternately repeat a landing period, when at least one leg of the robot is in contact with 

30 the ground, and a floating period, when all the legs float in the air, and said normal gait's desired trajectory is 

determined in such a manner that said vertical component of the translation floor reaction force for the normal 
gait's desired trajectory vanes in a convex pattern within the positive value region during said landing period and 
is kept at 0 during said floating period. 

35 13. The gait generation device for a legged mobile robot according to claim 7, wherein said normal gait generating 
means determines the vertical position of the total center-of-gravity or body of the robot for a predetermined period 
in said normal gait based on a geometrical condition concerning displacement of a joint of a leg. 

14. The gait generation device for a legged mobile robot according to claim 8, wherein, in generating the normal gait 
40 for creating said correlation data, the vertical position of the total center-of-gravity or body of the robot for a pre- 
determined period in said normal gait is determined so as to satisfy a predetermined geometrical condition con- 
cerning displacement of a joint of a leg. 

15. The gait generation device for a legged mobile robot according to claim 7 or 8, wherein said desired vertical com- 
45 ponent trajectory determining means determines said desired trajectory in such a manner that the vertical position 

of the total center-of-gravity or body of the robot and a vertical velocity of the total center-of-gravity or body of the 
robot at the end time of said current time gait satisfy a predetermined relationship with the initial state of said 
normal gait. 

50 16. The gait generation device for a legged mobile robot according to claim 7 or 8, wherein different dynamics models 
are used to generate said current time gait and said normal gait. 

17. The gait generation device for a legged mobile robot according to claim 1 , wherein the des ired traj ectory deter- 
mined by said desired vertical component trajectory determining means is a desired trajectory of said vertical 
55 component of the translation floor reaction force or vertical component of the total center-of-gravity acceleration, 

and 

said desired vertical position determining means comprises desired total center-of-gravity vertical position 
determining means and desired body vertical position determining means, the desired total center-of-gravity ver- 
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tical position determining means successively determining an instantaneous value of the vertical position of the 
desired total center-of-gravity of the robot using a value derived by second-order Integration successively from an 
instantaneous value of said vertical component of the translation floor reaction force or vertical component of the 
total center-of-gravity acceleration of said desired trajectory, and the desired body vertical position determining 
5 means successively determining an Instantaneous value of the desired vertical position of the body of the robot 

using at least a robol's model representing a relationship between the position/posture of a predetermined part, 
including the body, of the robot and the vertical position of the total center-of-gravity of the robot and an instanta- 
neous value of the vertical position of the desired total center-of-gravity of the robot. 

18. The gait generation device for a legged mobile robot according to claim 1 , wherein the desired trajectory determined 
by said desired vertical component trajectory determining means is a desired trajectory of said vertical component 
of the translation floor reaction force or vertical component of the total center-of-gravity acceleration, and 

said desired vertical position determining means further comprises desired total center-of-gravity vertical 
position determining means and desired body vertical position determining means for successively determining 

'5 an Instantaneous value of the desired vertical position of the body of said robot, the desired total center-of -gravity 

vertical position determining means successively determining an instantaneous value of the desired total center- 
of-gravity vertical position of the robot using a value derived by second-order integration successively from an 
instantaneous value of said vertical component of the translation floor reaction force or vertical component of the 
total center-of -gravity acceleration of said desired trajectory, and the desired body vertical position determining 

20 means using at least a last time instantaneous value of the desired vertical position of the body of the robot and 

a model which represents a relationship between the position/posture of a predetermined part, including the body, 
of said robot and the vertical position of the total center-of -gravityposition of said robot, thereby calculating an 
instantaneous value of the total center-of-gravity vertical position of the model and determining a current time 
instantaneous value of the desired vertical position of said body based on the difference between the calculated 

25 Instantaneous value of the total center-of-gravity position of the model and the instantaneous value of said desired 

total center-of-gravity vertical position. 

19. The gait generation device for a legged mobile robot according to claim 18. comprising means for successively 
detemnining a provisional desired vertical position of the body of the robot using at least the vertical position of the 

30 desired total center-of-gravity determined by said desired total center-of-gravity vertical position determining 

means and a second model representing a relationship between the position/posture of a predetermined part, 
including the body, of said robot and the vertical position of the total center-of-gravity of the robot, and said desired 
body vertical position determining means determines a current time value of the desired vertical position of the 
body by correcting the last time value of the desired vertical position of the body based on said difference and said 

35 provisional desired vertical position. 

20. A control device for controlling operation of a legged mobile robot in accordance with a desired gait generated by 
a gait generation device according to claim 1 , wherein the control device for a legged mobile robot comprises 
compliance control means for correcting the position and posture of an end portion of each leg based on a deviation 

40 of an actual floor reaction force applied to the end portion of the leg from a desired floor reaction force for the end 

portion of the leg determined for said desired gait. 
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FIG.6 

(DESIRED FLOOR REAQION FORCE'S VERTICAL COMPONENT) 

FLOOR REAQION FORa'S 
VERTICAL COMPONENT 




Tm(Ta) 



ONE-LEG SUPPORTING PERIOD 




TsC 



FLOATING 
PERIOD 



FIGJ 
(DESIRED ZMP) 



FREE LEG'S HEEL POSITION 
AT THE END OF GAIT- 



SUPPORTING LEG'S 
TOE POSITION 



SUPPORTING LEG'S 
HEEL POSITION 



Tm (la) 




WHOLE SOLE CONTAaiNG P 



ONE-LEG SUPPORTING PERIOD 



FLOATING 
PERIOD 



FREE LEG'S ANKLE POSITION- 



SUPPORTING LEG'S - 
ANKLE POSITION 0 




ONE-LEG SUPPORTING PERIOD 



FLOATING 
PERIOD 



►t 



70 



BMSCKDCID: <EP 1466705A1 l_ > 



EP 1 466 705 A1 




BNSDOCID: <EP 1466705A1_ I > 



71 



EP 1 466 705 A1 



FI6.9 

(BODY ROTATION MODE) 
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FIG.12 

(FLOWCHART OF GAIT GENERATION PROCESS) 
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FIG.13 

(DIVERGENCE STATE OF BODY POSITION) 
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FIG.14 

( PROCESS OF DETERMINING NORMAL GAIT PARAMETER) 
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FIG.15 

(RELATIONSHIP AMONG FOOT UHDING POSITIONS/POSTURES FOR NORMAL GAIT) 
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FIG.16 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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(FLOOR REACnON FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE) 
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FI6.18 

( DESIRED ZMP) 
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FIG.19 

( PROCESS OF SEARCHING FOR INITIAL DIVERGENCE COMPOKEMT FOR NORMAL m) 
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FIG.20 

( PROVISIONAL GAIT GENERATION PROCESS FOR NORMAL GAIT) 
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FIG,21 

(PROCESS OF DETERMINING NORMAL GAIT INSTANTANEOUS VALUE) 



C ENTRY 3 



DETERMINE DESIRED FLOOR REAOIOM FORCE'S VERTICAL 
COMPONENT AT TIME k BASED ON GAIT PARAMETER 



S400 



DETERMINE DBIRED ZMP AT TIME k BASED ON GAIT PARAMETER 



S4Q2 



5404 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURE AT TIME k BASED ON GAIT PARAMETER 



S406 



CAICUUTE TOTAL CENTER-OF-GRAVITY VERTIUL POSITIONAELOCnYTHAT 
SATISFIES DESIRED ROOR REACHON FORCE'S VERTICAL COMPONENT 



aiCUlATE BODY VERTiaL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



S408 



S410 



DETERMINE FLOOR REAQION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME k BASED ON GAIT PARAMETER 



S412 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION SO AS TO SATISFY DESIRED ZMP IN SUCH A MANNER THAT FLOOR 
REAQION FORCE'S HORIZONTAL COMPONENT Fx DOESNT EXCEED [Fxroin, Fxmox] 
AND INITIAL AND FINAL BODY POSTURE ANGULAR VELOCITIES AGREE WITH EACH OTHER 



CALCUUTE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGUIAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE AN6UUR ACCELERATION AND INTEGRATES THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE 



S414 



C RETURN ') 



82 



BNSDCXID: <EP 14S6705A1_J_> 



EP 1 466 705 A1 



RY 



FIG.22 

( PROCESS OF DETEKMINING BODY HORIZONTAL ACCELERATION 
AND BODY POSTURE ANGULAR ACCELERATION FOR NORMAL GAIT) 
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FIG.23 

FLOOR REAQION FORCE'S HORIZONTAL COMPONENT 

DETERMINED WITHOUT TAKING ALLOWABLE RANGE INTO CONSIDERATION Fxtmp 
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FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
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COMPONENT ALLOWABLE RANGE INTO CONSIDERATION Fx 
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FIG.26 

BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE 
(ZMPrec) 
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FIG.27 
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FIG.28 

FLOOR REAQION FORCE HORIZONTAL COMPONENT Fx 
DETERMINED TAKING FLOOR REAQION FORCE HORIZONTAL 
COMPONENT ALLOWABLE RANGE INTO CONSIDERATION 
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FIG.29 

aOOR REACnON FORa HORIZONTAL COMPONENT Fx 
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FIG.31 

(REUnONSNIP AMONG BODY POSITIONS AT THE TIME OF LANDING FOR NORMAL GAIT) 
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FIG.32 

( PROCESS OF PROVISIONALLY DETERMINING CURRENT TIME GAIT PARAMETER) 
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FIG.33 

{ FLOOR REACnON FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE ) 
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FIG.34 

( PROCESS OF CORREQING CURRENT TIME GAIT PARAMETER IN SEARCHING MANNER ) 



C ENTRY ^ 



S702 



S700 



OO 



CALCUUTE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON PROVISIONAL 
DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS 



S704 



DETERMINE HNAL DIVERGENCE COMPONENT qO[k] FROM BODY POSITION/VELDCITY 

(Xe, Ve) AT THE END OF CURRENT TIME GAIT USING FORMUU: 

qO[k3 = Xe + Vxe/coO 



DETERMINE FINAL DIVERGENCE COMPONENT ERROR errq USING FORMULA: 
errq = qO[k] - q" 



5706 



S708 YES 

errqFALLSWITlHNALLOWABLERANGE?V Cg™jM> 



S7T0 



CALCUUTE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON DESIRED 
ZMP OBTAINED BY CORRECTING PROVISIONAL DESIRED ZMP ACCORDING TO 
REUTIONSHIP SHOWN IN FIGURE 38 ON THE ASSUMPTION THAT a Aa 



BASED ON BODY POSITION/VELOCITY (Xel, Vxel) AT THE END OF CURRENT 
TIME GAIT WHICH IS RECALCUUTED BASED ON CORRECTED DESIRED ZMP, 
DETERMINE FINAL DIVERGENCE COMPONENT q1[k] USING FORMUU: 
qUk]:=XeUVxel/a)0 



S712 



DETERMINE PARAMETER SENSITIVITY r USING FORMUU: 
r = (ql[k]-qO[k])/Ao 



S714 



S716 



ADD CORRECTION QUANTITY DETERMINED ON THE ASSUMPTION OF o = -errq/r 
TO PROVISIONAL DESIRED ZMP TO RENEW PROVISIONAL DESIRED ZMP 



S718 



DETERMINE BODY INCLINATION RESTORING MOMENT IMP-CONVERTED VALUE PAHERN 
BASED ON DIFFERENCE BEIWEEN FINAL BODY POSTURE ANGLE FOR PROVISIONAL 
CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGLE FOR NORMAL GAIT AND 
DIFFERENCE BETWEEN FINAL BODY POSTURE AN6UUR VELOCITY FOR PROVISIONAL CURRENT 
TIME GAIT AND INITIAL BODY POSTURE AN6UUR VELOOTY FOR NORMAL GAIT 



DETERMINE. AS DESIRED ZMP PATTl N, PAHERN OBTAINED BY ADDING 
BODY INCUNATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN 



S720 



C RETURN ^ 



90 



EP 1 466 705 A1 



FIG.35 

(PROCESS OF GENERATING PROVISIONAL CURRENT TIME GAIT] 



C ENTRY ^ 

S800 

INITIALIZE 

PROViSIONAL GAIT GENERATION TIME k=:0 
VALUES IN CURRENT TIME SUPPORTING LEG COORDINATE SYSTEM 
CONVERTED FROM FINAL STATE OF LAST TIME DESIRED GAIT IS USED 
AS INITIAL STATES OF CURRENT TIME GAIT 



S802 



S804 YES 


CURRENT TIME GAIT INSTANTANEOUS 
VALUE DETERMINATION SUBROUTINE 


k < Tcurrs? <^ 




S808 




k=k+Ak 



C RETURN ) 



,1466705A1.J > 



91 



EP 1 466 705 A1 



FI6.36 

{PROCESS OF DETERMINING CURRENT TIME PROVISIONAL GAIT INSTANTANEOUS VALUE) 
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FIG.37 

{ PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION 

AND BODY POSTURE ANGUUR ACCELERATION FOR CURRENT TIME GAIT) 



C ENTRY 3 



SIOOO NO 



k LIES WITHIN 
BODY 

INCLINATION 
ANGLE 
RESTORING 
PERIOD 
[To, Tb]? 



C RETURN ) 



YES 



SI 002 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP 
IN THE CASE WHERE ROBOT MOVES IN BODY TRANSUTION MODE 



SI 004 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS « tmp 



S1D0I 



SI 006 Fxtmp > Fxmax 



Fxtmp ? 



^ . ^Fxtmp < Fxmin 



DETERMINE HORIZONTAL COMPONENT Fx 
OF FLOOR REACTION FORCE USING FORMUU: 
Fx 55 Fxmox 



Fx = Fxmin 



ELSE 



Fx = Fxtmp 



S1010 
S10I2 



SIO 



DETERMINE BODY HORIZONTAL ACCELERATION a IN BODY 
TRANSIATION MODE AND BODY ANGULAR ACCELERATION ^ 
IN BODY ROTATION MODE USING FORMULAS: 
a = ottmp + (Fx - Fxtmp)/ A Fp 

/3 = (otmp-a)*AMp/AMr 



SET BODY INCUNATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PAHERN 



S1016 



SI 01 8 



CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN AT TIME k 



yS =-ZMPrec*Fz(k)/AMr 



SI 020 



SI 022 



DETERMINE BODY HORIZONTAL ACCELERATION atmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP IN THE 
CASE WHERE ROBOT MOVES ONLY IN BODY TRANSLATION MODE 



a = Qftmp-(AMr/AMp)*;8 



S1024 



SI 026 



DETERMINE FLOOR REAQiON FORCE'S HORIZONTAL COMPONENT Fx 
IN THE aSE WHERE BODY HORIZONTAL ACCaERATION IS a 



93 



i4ee70SAi_i .> 



EP 1 466 705 A1 



FIG.38 

(CORREQION OF DBIRED 2MP) 
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FIG.40 

(BODY INCUNATION ABOUT WAIST) 
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FIG.41 

( BODY HORIZONTAL POSITIONAELOCITY AT END OF CURRENT 
TIME GAIT CONVERGING TO CERTAIN NORMAL GAIT) 
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FIG.42 

(DESIRE FLOOR REACTION FORCE'S VERTiai COMPONENT AT WALKING TIME) 
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FIG.43 

(DETERMINATION PROCESS o FOR fLOOR REAmON FORCE'S 
VERTiai COMPOHENT TRAJEaORY PARAMETERS FOR WALKING) 
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FIG.45 

{ DETERMINATION PROCESS FOR FLOOR REACTION FORCE'S VERTiaL COMPONENT 
TRAJEQCRY PARAMETERS AT THE TIME OF SHIFT FROM WALKING TO RUNNING ) 
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FIG.46 

(BODY VERTICAL POSITION DETERMINATION PROCESS: METHOD 1 ) 
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FIG.47 

(BODY VERTICAL POSITION DETERMINATION PROCESS: METHOD 2 ) 
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